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Abstract 


This report describes three computer subroutines designed to solve the vector- 
dyadic differential equations of rotational motion for systems that may be idealized 
as a collection of hinge-connected rigid bodies assembled in a tree topology, with 
an optional flexible appendage attached to each body. Deformations of the 
appendages are mathematically represented by modal coordinates and are assumed 
small. Within these constraints, the subroutines provide equation solutions for (1) 
the most general case of unrestricted hinge rotations, with appendage base bodies 
nominally rotating at a constant speed, (2) the case of unrestricted hinge rotations 
between rigid bodies, with the restriction that those rigid bodies carrying appen- 
dages are nominally nonspinning, and (3) the case of small hinge rotations and 
nominally nonrotating appendages, i.e., the linearized version of case 2. Sample 
problems and their solutions are presented to illustrate the utility of the computer 
programs. Complete listings and user instructions are included for these routines 
(written in Fortran), which are intended as general-purpose tools in the analysis 
and simulation of spacecraft and other complex electromechanical systems. 




> -< 
■: T-.a-'i 





Attitude Dynamics Simulation Subroutines for 
Systems of Hinge-Connected Rigid Bodies 
With Nonrigid Appendages 


I. Introduction 

Equations of motion which characterize the small, time-varying deformations of 
an elastic appendage attached to a rigid body experiencing arbitrary motions have 
been derived in detail for distributed-mass finite element models in Ref. 1, and for 
discrete mass models in Ref. 2. With the general structure of the appendage 
deformation equations established in these references, coordinate transformations 
are developed in Refs. 1 and 3 in order to allow representation of the elastic 
appendage in terms of a set of truncated modal coordinates far fewer in number 
than the original set. In Ref. 4, additional equations of motion are derived to 
describe the rotations of typical bodies in a system of hinge-connected rigid bodies 
arranged as a topological tree, with optional arbitrary nonrigid appendages at- 
tached to each rigid body in the system. In this respect, the results of Hooker in 
Ref. S and those of Ref. 4 are parallel. 

It is the purpose of this report first to draw together the appendage equations 
and the equations describing rigid body motions of the tree system, assumiitg that 
some or all of the rigid bodies carry nonrigid appendages, and to derive a 
consistent and detailed set of system dynamical equations suitable for digital 
computer solution. Secondly, it is the purpose here to present general-purpose 
computer subroutines capable of solving the resulting system equations of rota- 
tional motion, and to demonstrate their utility and apphcability to a wide class of 
spacecraft. 
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In generating the equations of motion for the hinge-connected tree of rigid 
bodies with nonrigid appendages, two specific formulations are obtained. The first 
formally constrains' appendage base motion to small deviations from a nominal 
constant angular velocity in inertial space, thus allowing appendage rotation but 
with only small deviations from a constant rate of spin. The second formulation 
formally permits no spin and constrains appendage base motion to small deviations 
froin a nominally zero angular velocity (and acceleration) in the inertial frame. 
However, both formulations permit otherwise unrestricted motions of the system 
rigid bodies consistent with the fundamental assumption of small appendage 
deformations from some no min al state. Computer subroutines (written in Fortran) 
are described which solve the equations produced by each of these approaches. In 
addition, a third subroutine is presented which solves the completely linearized 
equations for the nonrotating case, under the assumption that all rigid body 
rotations and their derivatives are small. 

The computer programs are direct descendants of those described in Refs. 6 and 
7, which are applicable to the hinge-connected rigid body tree without nonrigid 
appendages. All of the programs are designed to calculate the angular accelerations 
for every rigid and nonrigid body in the system but do not perform numerical 
integration. Thus, the routines are intended as general-purpose tools, to be called 
into action by the user’s own particular simulation language, whether this be CSSL, 
CSMP, MIMIC, or some “homemade” variety. Each of the routines allows the user 
to prescribe the motion of any rigid body in the system rather than allow it to be 
calculated, a feature often useful for eliminating unwanted dynamics or for 
“rigidizing” certain joints in sensitivity studies. 

II. Unrestricted Systems 120 92 

A. Mathematical Model 

Any problem of dynamic analysis must begin with the adoption of a mathemati- 
cal model representing the physical system of interest. In what follows, it is 
assumed that the model consists of n + 1 rigid bodies (labeled ... ,4 ^ inter- 
connected by n line hinges (implying no closed loops and, hence, tree topology), 
with each body containing no more than three orthogonal rigid rotors, each with an 
axis of symmetry fixed in the housing body, and moreover with the possibility of 
attaching to each of the n 1 bodies a nonrigid appendage, with appendage 
attached to body S^. 

If the actual connection between two massive portions of the physical system 
admits two (or three) degrees of freedom in rotation, then the analyst simply 
introduces one (or two) massless and dimensionless imaginary bodies into his 
model (as though they were massless gimbals). Since the number of equations to be 
derived here matches the number of degrees of freedom of the system, no price is 
paid in problem dimension by the introduction of imaginary bodies. 

Each combination of a rigid body and its internal rotors and attached flexible 
appendage comprises a basic building block, referred to here as a substructure-. 


' Deviations from nominal appendage base motion are treated as small in the sense that their products 
with appendage deformations are ignored, but nonlinear terms in these base motion deviations alone 
are retained. Thus, there is a format limitation to small base motion deviations from nominal, but in 
practical applications, substantial deviations are accommodated quite satisfactorily. 
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thus, there are /i + 1 substructures in the total system, so labeled that encom^ 
passes a^, and any rotors in ^ 


Definitions and Notations 

Definitions and notational conventions are as foUows (see Fig. 1): 

Def. 1. Let n be the number of hinges interconnecting a set of /» + 1 substructures. 

Def. 2. Define the integer set ® = {0, 1, . . . , n). 

Def. 3. Define the integer set 9 = {I, . . . , n). 

Def. 4. Let ^ assigned to one rigid body chosen arbitrarily as a 

reference body, and let be labels assigned to the rest of the 

rigid bodies in such a way that if is located between and then 

0<j<k. 

Def. 5. Define dextral, orthogonal sets of unit vectors b^, b*, bj so as to be 
imbedded in for Ic E , and such that in some arbitrarily selected 
nominal configuration of the total system, b^ = b^ for a = 1, 2, 3 and 
k,je<S>. 



Fig. 1. Definitions for the kth substructure, with J <k 
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Dej. 6. Define 


bt 
b^ 
b5 

Def. 7. Define {i} as a column array of inertially fixed, dextral, orthogonal unit 
vectors I,, i 2 , 13 . 

Def. 8. Let C be the direction cosine matrix defined by 

{b°} = C{l} 

Def. 9. Let uP = be the inertial angular velocity vector of that w° is 

the corresponding 3 x 1 matrix in basis {b°}. 

Def. JO. Let c* be the mass center of the ^th substructure, k G ‘S> . 

Def. II. Let /<* be a point on the hinge axis common to and ^ for j < k and 

kG<9. 

Def. 12. Let p*^ be the position vector of the hinge point connecting and from 
the point o* occupied by c* when the k\h substructure is in its nominal 
state. 

Def. 13. Let c* be the position vector from c* to o*. 

Def. 14. Let p* be the position vector to c* from the system mass center CM. 

Def. 15. Let X be the position vector to CM from an inertially fixed point J , and 
letX = X-{l). 

Def. 16. Let be the mass of the A:th substructure, for A: G . 

Def. 17. Let (p)* be a generic position vector from o* to any point in the ^th 

substructure. 

Def. 18. Let be a point common to rigid body and flexible appendage 

Def. 19. Let R* = be the position vector fixed in locating g* with 

respect to o*. 

Def. 20. Let (r)* = {b* } be a generic symbol such that R* + (r)* locates a 
typical field point in with respect to when the flexible appendage is 
in some nominal state (perhaps undeformed). For a discretized appendage 
let (r^)* = {b*}^(r^)* locate the Jth node in the nominal state. 

Def. 21. Define the generic deformation vector (u)* in such a way that^ 

(p)*=R* + (r)*+(u)‘ 

and 

(p)‘=R* + (r)‘+(«)* 


^ Superscripts on generic symbols such as p, r, and u will be omitted when obvious, as when the symbol 
appears within an integrand of a definite integral. 


^ e ® 
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For a discretized appendage let (a*)*= {b*}^(u-*)* be the deformation 
vector for node s. 

Def. 22. Let g*= be a unit vector parallel to the hinge axis through^^. 

Def. 23. For ^ 6 “S' , let ^ angle of a g* rotation of with respect to the 
iKxiy attached at Let be zero when = b^(a= 1, 2, 3; j, k e 

Def. 24. Let J* = {b*}^7* {b*} be the inertia dyadic of the A:th substructure for o^, 
so that J* is time-variable by virtue of deformations. 

Def. 25. Let F* ={b*}^F* be the resultant vector of all forces applied to the Arth 
substructure except for those due to interbody forces transmitted at hinge 
connections. 

Def. 26. Let T* = {b*}^?"* be the resultant moment vector with respect to of all 
forces applied to the A:th substructure except for those due to interbody 
forces transmitted at hinge connections. 

Def. 27. Let be the scalar magnitude of the torque component applied to in 
the direction of g* by the body attached at^*. 

Def. 2d. Let F = 2 “ {b°}^F be the external force resultant for the total 

ke<& 

system. 

Def. 29. Define the scalar such that for A: € ® and j £ 0* 

^ I if/i, lies between ^0 and/* 

i 0 otherwise 

(The n(n + 1) scalars «,* are called path elements.) 

Def. 30. Define = 2 system mass. 

ke'ii 

Def. 37. Let C'’ be the direction cosine matrix defined by {b'’} = {b-'}, 

r,j £ ® . (Note that in the nominal state, C'"-' = U, the unit matrix.) 

Def. 32. Let denote the index of the body attached to /* and on the path 
leading to / „ and let fV** = k. (These are the network elements.) For 
notational simplicity, use iV* for 

Def 33. For^ r £ ® - k, let L*' ^ p*^^ and let L** = 0. 

Def 34. Define D** = - 2 L*-'<!)Il./<5Il for A: £ ® . 

ye* 

Def. 35. Let h* be a point fixed in /* such that D** is the position vector of o* with 
respect to h*. (This point h* is called the barycenter of the A:th substructure 
in the nominal state.) 

Def 36. Define {b*}^D*> s D*^ = D** + L*-' for k,je%. 

Def. 37. Define the dyadic 

K*= 2 
/■€« 

’ For notational brevity, the set % - {<:) is designated — k. 
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where U is the unit dyadic, and define the corresponding matrix K'‘ = 
{b*} -K*- {to*}’". 

Def. 55. Define 


0** = K* + J* and ^ s {b*} • {b*}^ 


Def. 39. Define 


= - <DIL(D-'* • D*-'U - D-'*D*-0 


with 


{b>} {b*}^= - 

Def. 40. Let = {b*}^w* be the mertial angular velocity of 4^. 

Def. 41. Let h* be the contribution of rotors in 4^ to the angular momentum of the 
Jkth substructure relative to 4^ with respect to o^, and let A* = h*- {b*}. 

Def. 42. Let be the rth neighbor set for r £ 'S , such that AE®, ifrf^is 
attached to 4,. 

Def. 43. Let be the branch set of integers r such that r G if A: = AAy,. Thus, 
consists of the indices of those bodies attached to 4j on a branch 
which begins with 4^. 

Def. 44. Let the tilde symbol (*) signify, in application to a 3 by 1 matrix V with 
elements K, (tf = 1,2,3), transformation to a skew-symmetric 3 by 3 
matrix F given by 



B. The Equations 

The objective of this section is to begin with the general vector-dyadic equations 
derived in Ref. 4 and to proceed by sacrificing some of their generality in favor of a 
particular appendage model. Explicit results, in the form of both vector and matrix 
equations suitable for computer programming, will thereby be obtained. 

In what follows, attention is confined to a special case of the finite element 
appendage model of Ref. 1, for which, as in Ref. 2, all mass of appendage k is 
concentrated in the discrete nodal bodies of the appendage (with no distributed 
mass for the intemodal elastic elements). All deformations from a nominal appen- 
dage state are assumed arbitrarily small, so that terms above the first degree in 
these deformations (and corresponding rates) can be neglected. Further, any rigid 
body 4 ^ will be assumed to carry rotors, and. they will consist of an orthogonal 
triad whose axes parallel b*, b^, and b*. 
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The starting point for this development is the set of vector-dyadic equations of 
vehicle translation and substructure rotation as derived in Ref. 4 (Eqs. 9, 31-35): 


F= <DHX 

(1) 

2 w* = o 

(2) 

ke.9, 


T, + g^- 2 €,*W*=0 (SG-?) 

(3) 




where 


W‘ = T*-K 2 D^'xF + c^xI^F-F*! 

+ 2 ‘DH,D*"x[5T + 2«'xi"-Ku"xc'-H«"x(M'xcO] 

r£<3i 


<DIL*c* X 2 [«'’ X ly* -Kb-- X («'■ X EK*)] 


and 


2 “311 2 D*" X [«^ X (ctf^ X ly*)] 

re9)-k rS.9>-k 

— «* X O** • «* — h* — «g* X h* — 4^ • »* 

— r p X p d/« — «a* X r (p X |i) dm (4) 

•'a* •'o* 


«* = «° -t- 2 
/■eg” 


(5) 


«* = «° + 2 «r*[Y,g'’ + w' X g^Y,] (6) 


The adoption of a nodal body appendage model leads (as in Ref. 2, Eq. 58) to 
the following useful relation: 





(7) 


where appendage a,, has, been idealized as n,^ nodal bodies interconnected by 
massless elastic structure, with m^ the mass of nodal body s, and ly the displace- 
ment of the body s relative to from the position occupied in the nominal state. 

It wUl also be necessary to develop an expression for 4*** in terms of appendage 
variables. From Def. 38, we know that 
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4>** = K* + J* 


( 8 ) 


where K*, the “augmented” inertia dyadic, is a constant. J*. the inertia dyadic of 
the /cth substructure for o*. is time-variable due to appendage deformations and 
may be obtained from 


J* = J(P ■ pU ~ pp)dm 


( 9 ) 


where U is the unit dyadic. 


For the small-deformation appendage model adopted here, J* may be evaluated 
(see Ref. 2, Eq. 126) as 


J* = J* {b*}^ 


2 {/nj2(/?* -1- r^yu^U - (/?* + r‘)u‘^ 


- -I- rOT + ) 


{b*} 


( 10 ) 


where J* is the nominal (constant) value of J*, and is the constant inertia matrix 
of the jth nodal body for its own mass center and in its own body-fixed vector 
basis (n^)*, where in the nominal state, {n'}* = {b*}. 


Combining (8) and (10), we have 


4*** = {b*}^^ 




2 {/w,[2(/?* -I- rYu’U-{R'‘ + rOti'" 


- ii'(R* -1- rOT + } 


(b*} 


( 11 ) 


Finally, Eq. (4) requires more explicit expressions for the integrals over the 
appendage a^. The appropriate expressions in this case may be found in Eq. (114) 
of Ref. 2, which simplifies to 


— ^ j pxp dm = — j pxprf/n-«*x j pX.p dm 


or 


- -X f pX p dm = - ^ (R* + r') X m,S’ - «* X 5] (R* + r') X m.u’ 
" ,-i ,ri 


n* 


- 2 + xF /5") 

i-l 


( 12 ) 
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Note that in Eqs. (7), (10), (II), and (12), the superscript k has been dropped 
from nodal body variables in the /cth appendage (such as u\ which replaces (u^)*). 

Turning now to the appendage equations, we will make use of the nodal body 
finite element model case described by Eq. (95) of Ref. 2 (correcting the last 
algebraic sign within the braces on the right side of Eq. 95 by changing - to +, 
and subtracting all nominally nonzero terms from the right side so as to make q a 
measure of the deviation from a nominal state in which the appendage might be 
deformed). In matrix form, the equation for the kth appendage becomes 


M* 


U 2 yo2 


T 

UO 


ML 

9IL* 




(2 ) 2 


ml 


+ A/*(2ot/«*)' + (2ou«*)-M* - (A/*2oi/«*)- 


4 


k 


+ A/*(2oy<0*)- - - (2ot/«*)'(A/*2oi/‘^*)' 




(2yo«*)- 




+ /c* 


= - A/* (2o(/«* + 2yo[0'^ - - n*fi*R*] 

-(2o(/W*)'A/*(2oi/«*) + (2ot/fi*)'A/*(2ot;fi*) + A* (13) 


where the assumption has been made that the appendage structure contains no 
damping. The symbol is a column matrix containing any forces or torques 
applied to the sub-bodies of the appendage other than the structural interaction 
forces induced by deformations. For example, gravity forces or attitude control jet 
thrust would contribute to X*. Also, 

a by 1 matrix which fully characterizes the appendage deformations 
relative to some nominal state of deformation induced by the nominal 
constant value fi* of u*. 
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a constant, symmetric 6/i* by 6n^ matrix defined in terms of the 3 by 3 
partitioned matrices m", I’. 



2yo = [f/ 0 1/ 0 • • • C/ of 

Sou = [0 ^ 0 U • • • 0 

6/jj by 3 Boolean operator matrices, where U and 0 are the 3 by 3 unit and 
null matrices, respectively. 

r* = [r'*’ 0 0 • • • 0]^ 



a constant (>n,^ by 6/1^^ matrix. 


K'^ = the stiffness matrix that determines the structural interaction forces and 
torques induced by deformation of the /cth appendage from its nominal 
state (a constant, symmetric 6/i* by 6/i;^ matrix). 


" It should now be recognized that the term in Eq. (13) must be replaced by 

< the inertial acceleration of the mass center of the corresponding substructure in the 

local vector basis, which is assumed for each k to be zero in the “nominal” state. 







ex = C'^CX - (c* + w*c* + 2£j*c* + «*5*c*) 


JO'- (<o' + 5'50[/>'*+ ^(c' + 25'cO 


( 14 ) 


. and 



treated as zero in the nominal state. 


(15) 


Equations (1)-(15) provide a rather complete system description (although the 
contribution of rigid rotors, i.e., h*, will be developed in more detail later). Since 
the number of nodes in a single finite-element model of an elastic appendage is 
typically rather large, it is to be understood that the nodal body vibration 
equations, (Eqs. 13-15), will provide the basis for a transformation to distributed or 
modal coordinates for appendage deformations and that most of these will be 
deleted from consideration by truncating the matrix of deformation variables. 
Thus, the variables labeled u‘ and above will be replaced by appropriate 
combinations of new modal deformation variables. 


The equations actually to be programmed for digital computer solution will 
therefore be the transformed and truncated versions of Eqs. (1)-(15). These will be 
described in the following sections as the system motions are confined to two 
particular cases of interest: (1) the case in which all appendage base-body angular 
rates experience only slight deviations from some constant nonzero value (i.e., 
«*w0), or (2) the case in which (i.e., w*«0, w*s»0) for all 

appendage base bodies. 

In the first ctise, i.e., where and the approach taken in develop- 

ing the system equations of motion, including linearization, coordinate transforma- 
tion, and truncation, may be described as follows: 

(1) For the purposes of constructing a coordinate transformation for the ap- 
pendages, assume that w* experiences only small deviations from a constant 
12*, and write the homogeneous form of the appendage equations. 

(2) Construct a coordinate transformation from these linear, constant-coefficient 
equations, and select the truncation level. 

(3) Return to the unrestricted w* assumption, and substitute the transformations 
from (2) into all equations of motion. 

(4) In the homogeneous part of the appendage vibration equations only, ignore 
products of deformation variables and deviations of «* from S2*. This step is 
not formally correct, since mathematically we cannot justify treating the 
deviation of w* from P* as smaU only when it is multiplied by a deformation 
variable. On the basis of engineering judgment, however, the authors feel 
that it is probably justifiable and would be a less significant source of error 
than either modeling or truncation. The resulting equations contain all terms 
formally required for the analysis of a system with appendage base bodies 
experiencing small deviations from their nominal motions, but in applying 
these equations to systems with large deviations of base bodies from their 
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nominal motion one is suppressing products of these deviations with defor- 
mation variables. In fact, a very large change in base-body spin rate would 
' change the effective structural stiffness of the appendage, and invalidate the 
modal analysis on which the appendage modal coordinate selection is based. 
In this respect, the equations would be tainted by truncation even if the 
suppressed terms were retained, and, since these terms would substantially 
complicate the analysis by coupling all variables into each vibration equa- 
tion, they have been rejected here. 

N76 12093] 

III. Systems With Rotating Appendages 

A. Equations 

Inspection of the appendage equations (Eqs. 1 3- IS) reveals that the coefficients 
of 9 * and depend upon u*, which characterizes the rotational motion of the 
appendage base. In general, u* is an unknown function of time, to be determined 
only after the appendage equations are augmented by other equations of dynamics 
and control for the total vehicle and solved. Only if u* can be assumed to 
experience, in a given time interval, small excursions about a constant nominal 
value Q* is there any possibility of transforming Eq. (13) to a new set of uncoupled 
appendage coordinates. Any methods involving modal coordinates (see Re^ 1, 
Sect. I) depend formally upon this assumption. 


Assuming then that and w*iss0, Eqs. (13)-(15) can be combined to 

provide the following appendage equation: 



t/ “ 2 (/o2 


r A£l\ 
t/o I 


q* + 



(2 t;oB*)* - 2c;oK*2 


r 

t/o 


A/* 

<511 






-1- A/*(2oyS2*)* + (2oyn*)' A/* - (A/*2o:,B*)- j?* 

+ { -(2ot,n*)-(A/*2ot/n*)' + (2ot/n*)'A/*(2oX) 


+ M* 


-2i,o(Q*n*)2i;o^ +(2t/on*)'(2(/on*)' 


-I- /:* 9* 


(-A/*2ot/+A/*2yo^‘ + A/*r*2t,o)«‘- A/‘2c,o I 


-A/' 


2,/oC*" 4: + (2,;„u,*)-(2^/o«‘)>*] 


- (2ou«*)-A/*(2ot/«*) + ^‘ + + (2 (,o«*)'(2£/oB*)>*] 

-»■ (2o„fl*)-A/*(2oyfl*) 


-A/*2yo 2 C*' 




giL, 


rS® -* 


911 


91L 


91L, 

■gii 


(16) 


12 
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Equation (16) consists of 6/ij^ second-order scalar equations and can be written 
as a matrix equation with the' following structure: 


where 






D^ = 0 


(2yo2*)‘ 


2 1/(^*2 yo + Af*(2oi/i2*) 






K,' = (2oy2*)'^"(2o£/fl*)* + 


+ M* -2i;o(«*Q")2i;o^ +(2c;oa‘)*(2c/o2*)- 


L; =• - A/‘[2oy - 2t,o(^* + ^**) - ?*2t,o]«* - A/*2c,oC*” W 


- A/*2 yo 2 -I- iv; - Af" 


reS -fc 


re« -Jfe 




AT;= -M*[2i/oW*5*(i?* + f?**) 


+ (2c,o"*)'(2t/o«*)>*l - (2otA<’*)'A^*(2ot/«*) 


AT4 = -A/*[2j,o^fl*(/?* + /?**) + (2yo2*)‘(2i/on*)>*] - (2oc/n*)'M"(2ot/B*) 


Matrices A/^, D;^, and A]^ are constant symmetric matrices, while G!^ is a constant 
skew-symmetric matrix, and A'^ has both symmetric and skew-symmetric parts. 
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contains the nonlinear terms in to* due to centripetal accelerations of the appen- 
dage due to u*, and represents the nominal steady-state value of N^. 

Notice that the form of Eq. (17) is identical to that of Eq. (140) in Ref. 2 (or Eq. 
64, Ref. 1), with the exception of the additional right-hand-side terms 


2 %jff 


i-ea -k 


which describe the coupling of appendage to other rigid bodies and appendages 
of the system. Also, in comparing Eq. (17) to Eq. (140) of Ref. 2, note that R has 
been replaced by (R* + D**), a vector from the mass center (barycenter) of the 
undeformed augmented substructure to the point (see Fig. 1 and Def. 35). 


At this point in the development of the appendage equations, it is appropriate to 
elaborate upon what is meant by “nominal appendage state,” and what relationship 
this idea has to Eq. (17). We have already indicated that the approach to be taken 
is that of Ref. 1 (see pp. 1-3), namely that appendages are ideally considered as 
linearly elastic and that u and /3 are “small,” oscillatory appendage deformations, 
i.e., variational deformations. It is quite possible that these small oscillatory 
deformations will be superimposed on relatively large steady-state deformations, 
due to spin, for example. 

In order to derive a suitable appendage equation, applicable for a “variational 
deformation” q, the substitution of an expansion for the total deformation q' such 
as 


q' = q + 

has been made in Eq. (17), where q„ (= constant) is understood to be the 
steady-state appendage deformation due to spin. The steady-state deformation is 
given by 


(A-; + ^,0q„ = ^4 

where 




In effect then, in Eq. (17), we have linearized about the steady-state deformation 
induced by centrifugal forces due to spin of the A:th substructure, with the mass 
i center of this substructure inertially fixed. It should also be remembered that the 

, ; original definitions of o^, c*, and the vectors (r)*, R*, etc., remain intact but that the 

• : term “nominal state” is more clearly specified as the “steady state” of deformation 

due to the nominal (constant) spin of the kth substructure, with the mass center of 
' j that substructure inertially fixed. Also, the value of /f* should include whatever 

increment to the elastic stiffness of the appendage is attributable to structural 
preload due to this spin; that is, iT* includes the so-called “geometric stiffness 
matrix” of the structure. 


14 
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The matrix D', which in the general case would accommodate any viscous 
damping that may be introduced to represent energy dissipation due to structural 
vibrations, is zero here since such terms have been omitted. But they can still be 
inserted if one accepts the practice common among structural dynamicists of 
incorporating the equivalent of a term D'^q‘‘ into equations of vibration only after - - 
derivation of equations of motion and transformation of coordinates. 

The nature of terms contributing to GL, and is discussed in some detail in 
Ref. 1. In particular, the matrix A’^ is shown in Ref. 1 to disappear for the case of 
small base excursions about a nonzero constant spin only if the nodal bodies are 
particles or spheres, or if in the steady state of deformation, all nodal bodies have 
principal axes of inertia aligned with the no min al value of the angular velocity to* 

(i.e., (b*}fl*). The latter restriction will henceforth be adopted in this report 

since it greatly reduces the computational task in transfor min g the homogeneous 
form of Eq. (17) to a set of completely imcoupled differential equations. 

In order to transform Eq. (17) to a set of uncoupled equations, it is first 
necessary to rewrite it in first-order form, such as 

+ e* ( 18 ) 


where 



£ = 

fol 

. . 

‘-it — 

1 


III 

51 

* o 
1 

1 

III 

1 

1 1 


o 
■ 

1 



i G*' J 


Now let $ be a (12/?^^ X I2n^) matrix of (complex) eigenvectors of the differential 
operator in Eq. (18), and let be a (I2n^ X 12/1;^) matrix of (complex) eigenvectors 
of the homogeneous adjoint equation 

'VJ'e'* = 0 (19) 

so that ^ 1 ^ and are related by 


with / a {\2rii^ X \2n^) diagonal matrix which depends upon the normalization of 
and Substitution into Eq. (18) of the transformation 


and premultiplication by furnishes 


($/ -H (<i>f e* 
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The two coefficient matrices enclosed in parentheses are diagonal. If A* is the 
(12n* X 12n^) matrix of the (complex) eigenvalues of the differential operator in 
Eq. (18). then upon premultiplication by one obtains 

( 20 ) 

Note that the matrix inversion in Eq. (20) consists simply of calculating the 
reciprocals of the diagonal elements of “^1 **!**• 

In practice, one may expect that physical interpretation of the new (complex) 
state variables Vf will permit truncation to a reduced set of variables 


K* =[ yf • • • 


where A* is the number of modes to be preserved in the simulation. The transfor- 
mation matrix <I>;^ is accordingly truncated to the (12n* X 2A*) matrix <t>^, where 

• • • <**] 

The equation of motion of the appendage now becomes 


( 22 ) 


Since, in the particular case studied here, the matrices and “Y* in Eq. (18) 
are, respectively, symmetric and skew-symmetric, so that Eq. (19) becomes 

- %Q'* = 0 (23) 

the adjoint eigenvector matrix is available as the complex conjugate 

(24) 

The final equations, after truncation of Eq. (24) and substitution into (22), are 
therefore obtained without the necessity of actually computing the eigenvectors 
constituting 4>'*. Thus, Eq. (22) becomes 

y* = A, F* -y (25) 

Since the appendage modeling process thus, far has assumed that the structure 
contains no damping, the diagonal matrix. A*, will contain only eigenvalues that 
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are purely imaginary, e.g., \„ = ± ia„. Conventional practice in structural dyna- 
mics, if some energy dissipation in the model is desired, is to rather arbitrarily add 
what amounts to a viscous damping term to the appendage equation after 

completing the modal analysis, assuming that the structure of is 'such that 
eigenvectors are undisturbed by this addition. Specifically, one 

substitutes X„, = ± ia„ into £q. (22) or (25), where is the “percent of 

critical damping” and is chosen based on experience (including tests) with similar 
structures. (See Appendix A for a discussion of some ramificatioI^s of adding 
damping after transforming the appendage equations to modal coordinates.) 

1 _ _ 

_ An apparent disadvantage of Eq. (25) is the fact that the quantities A*, and 
^ 1 ^ are complex. However, Eq. (25) can be written in terms of its real and 
imaginary parts and the resulting equations greatly simplified by the use of certain 
orthogonality relationships. The detailed development of the equations is shown in 
Ref. 3, and only the results are presented here. 

Realizing that must have the form 


H 



(*^i = yth column of = 1, . . . , \2nf) 


where + iP, {6n^ x 1), and letting T* = 5* + /t)*, T** = 5* - /tj*, (a 

= 1, . . . , 6n*), one can see from Ref. 3 that the real x 1 (truncated) matrices, 
5* and are the solutions to the equations 


- a^fm- 1*5*5* (26a) 

and 

= 5*6* - - |*5*ij* (26b) 

As a result, the relationships between the real quantities (y*, ^*, 5*, and 17*, in 
matrix terms, are as follows: 


9* = 2(,A*6 -*-r, 7i*) (27a) 

and 

^*= -2(r,5*5’*-l-^*5*7i*) (27b) 

so that 

^*= -2(r,5*5"*-b,^,5*^*) (27c) 

In order to complete the set of model equations, particularly in the form suitable 
for computer solution, it is necessary to return to the vehicle equations, substituting 
the relations developed in Eqs. (7), (11), (12), etc., into Eq. (4), to obtain 
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( 01L \ 

-5=pF-F* 
JIL I 


+ 2 

re* 


"2 ^‘^ + 2to'Xi' + a,'xc^ + u>'x(w'Xcr)\ 


j-i 


+ 91L*c* X 2 [a»' X D'* + «^ X (a^ X IX*)] 
re ® 


- 2 2 D*' X [w^ X («'• X EK*)] 

re * re a -k 


— ft)* X 4»** • <0* — h* — M* X h* 

j-i ^ 

+ 4V*- /#]{b*} a»* 

- 2 + r*) X — o»* X 2 (R* + r*) X WjU* 

j-i j-i 


- i (l"•^‘' + a»*xF•y3') (28) 

i-i 

Eliminating the use of R* for simplicity (noting that this is an arbitrary vector 
fixed in and it can always be chosen as zero) and substituting qr* and q’’ where 
appropriate, the matrix form of Eq. (28) becomes 


tf-* = r*+ 2 D*'’C*’’F'' + 

re* 


fk 



c 


k 


+ 2 

re* 


M 




+ w'u'c'’ 


+ ‘^ILfcC* 2 + 

re's 

I. 

- 2 2 3*r*'«"wT"*-w*$**«* 

re* re%-k 


- /i* - «*/i* - [2(A/VJ^^*I/ - r*^(M*9*)^^ - (A/*4*)V;J^ 

+ 2oy?*A/* - M*|*)2oy]«* - 

- (29) 
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where the operator f reassembles the 3 by 1 submatrices of a column matrix into a 
three-row matrix, as illustrated by 

r*^=[r‘ 0 0 ••• 0] 

Using the identity 


and regrouping some of the terms in (29), we have 


re® 


- [So^y + - 2 - A* 

re® 


2 D'"C'"F' + 

re® 




-I- 2 ‘3IL,^*"C*"(2«'c' + w'w'cO+ ? m*c* 2 

re® re® 

+ <DIL 2 D'"C'"u'u'D^'‘ - - «*/«* 

re® -* 

- - rliMY)^^-{MY)-rr 


(30) 


The truncated modal coordinates, 8* and may now be introduced into the 
/cth substructure equation by way of Eq. (27), as follows: 

+ <5ILfcC*C*'D'* + 

re® ^ 

- -I- 2 


re® 


r*-t- 2 D'"C'"F^ + 

r€® 




-t- 2 [?)TLr^*'C*'(2«"c'' + w"5"cO+ 

-h <51L 2 D'"C’"Z>'w'D''^ - «*4>**«* - 

re® -* 

( 31 ) 
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where 


A* = -25*rJ-A/‘(2o£/ - 

A; = — 2a*;/'*^A/*[2ot/ “ Oi2i/o] 

G* = 22yQA/*r* 

y* = 2{MY)\ - + 2oV 9‘A/‘ - A/‘4*)2o^ 

4>** = if* + y* 

$** a y* 

Using the relation in Eq. (6), the vehicle equations, (2) and (3), become (in 
matrix form) 

A°°u°+ '2'*°%+ E /<r"S"+ 2 Af”ri'”= 2 C°*E* (32) 

je9 me9 me? *e® 

and for i , 

2 A’Jyj-^- 2 AjrS”+ 2 Ar^’” = g^’' 2 + (33) 

ye? me? me? *e? 

where 

/<*’= 2 2 9H*c*C*"^"*+ 9H,3 *T*"c')C'^, 3 by 3 (34) 

fce* re® 

A°j= 2 2 91L*c*C*"i"*+ ‘31L,^*'C*"c%CV. 3byl 

*e® re? 

(35) 

2 2 €,*C**(4>*"C*' + ‘5!l*c*C‘"iD'* + 1 by 3 

ke? re® 

(36) 

^ 2 2 «r* «y,C’*(4)*'C‘" + <DIL* C*c*"^"* + 91L, ^*'C*'c")C V, 

*e? re® 

1 by 1 (37) 

^om^^Om^m’-. ^ C°"^""C""C„5'", 3 by iV„ (38) 

re® 

^Om^ COm^m«-_ 2 c°"^""C""P„a'”, 3byiV„ (39) 

re® 
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(40) 



Ar = - 2 €,,C"D"”C"”G„d'”], 

V re« / 

' re®. - / 

= the integer set containing the labels of only those rigid bodies of the system 
that possess a nonrigid appendage. 

£* = 7* - T* - «* f («* + 4'k)+ 2 D'^'C'^F' 

re® 


lbyyV„ 

lbyAT„ (41) 



c* + 91L 2 D'^C'^Zi'u'D''^ 

re® -* 


- 5*$**„* - y*u* - w*(a*’’S* + Af ij*) 

- 2 91L*c*C*'^'*+ 0IL,P*'C*'c')- 2 

re® L js9 


- giL,.D*'’C*'(2w'-c' + «'w'cO- ‘5lL*c*C*'«'w'Z)"* , 


3 by 1 


(42) 


and substitutions have been made for h'‘ and />* based on restriction to three 
orthogonal axisymmetric rotors in with spin axes aligned to the unit vectors 
{b*}, and the following equations: 


A* = f 

(43) 


(44) 


(45) 


where 

=^- {b*} = 3 by 1 matrix of components of spin rate relative to for three 
orthogonal axisymmetric rotors in 

= spin-axis inertia matrix (diagonal) for the three axisymmetric rotors in A^. 

Tg =Tg - {b*} = 3 by 1 matrix of applied torque on the three axisymmetric rotors 
in/*. 

It is to be understood that when symmetric rotors are present in the A:th 
substructure, the rotors’ mass and moments of inertia are to be included in J*, the 
undefonned substructure’s inertia dyadic for o*. Of course, the mass of the rotors is 
also to be included in the substructure mass and c.m.-location calculations. 

Equation (44) then provides up to three scalar differential equations which are 
uncoupled in acceleration from the system’s vehicle/appendage equations. They 
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may be integrated and, with u* and known, can be solved for \i>^, which is then 
supplied to Eq. (42). ^ 

If one now operates on the appendage equations, Eqs. (26), in a similar way, they 
may be expressed as 

me^: 


where 


+ 2 <2"-'Yy + 2 + 2 = Qr 

ne9 ne? 

2 <5D"Vyy+ 2 “^75"+ 2 = 

je9 ne9 ne? 


2 L "re® 


. A^»by3 


6E«/ = j 




re9 


g^, N„hy\ 


(46) 

(47) 

(48) 

(49) 


eT = -jS”Gj;C'^G„^, N„byN„ (50) 

^7 = i/, (m = /»); A^„by;V„ 

a- = - i o'^GlC’^P„ IJ; . C'” ^ «); by iV„ (51) 

(£7«=0. (m = n); N„byN„ 


6J)mO ^ 

1 



. ■^mby3 

(52) 


z 


/•e* 

J 

1 



6j)"y _ 




C7 

g^, N„by\ 

(53) 


z 

L 

<■€3 





= 

- ■ 

1 a'”Pj:C””G„ , (m 

2 "911^ 

n); 

by /v„ 

(54) 

fij)™ = 

0, 

(m = «); 

^«by^„. 




(55) 

<5j)™ _ 

- • 

J- d'”Pj:C””P„ , (m 

2 ” " <511 ^ 

n); 


. byfV„ 

(56) 

<50™ = 

u. 

(m = n); 





(57) 
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= + 5 « J -fj”- rS” + i - rlX„j - Z”, N„ by 1 
Qr - + a-f 5" - rTf"* + i - &„] - zr, -iV„ by 1 

+ 2 C”“a'w'D'” 

fC=<5R 


+ 2 

re® -m 


9IL, - . 

(2«'c'' + u'u'c') - 


3 by 1 


Z„ - X" - M'"(2t,o^'")-(2 - (2ot/«'")‘A/'"(2oi/«'") 

+ M"(2c/ofl'")'(2£,o«'")>« + (2 o4/Q”)-X/'"(2o£/Q'"). by 1 

? 2 {^R^jn.C^ + 5-GJ 2 N„ by 1 

* je9^ re® / 

Zr = T 2 fe>«C-v + 5"-Pj 2 C"3"”ef,cA<:^g% N„ by 1 

^ je<9^ re® ' 

Recapping, the system equations (minus the rotor equations) are as follows: 

rl«’co°+ 2 A^”t” + 2 A°’”^’”= 2 C°*Z* 

ye® me® me® *eS 

j e ^ ; 


r4"°«°+ 2 ^"■'ry+ 2 2 = 2 «r*C'*Z*+T, 

ye® me® me® ke® 

m £ ^: 

2 ®'^Yy+ 2 ®7^"+ 2 &Tv"=Qr 

ye® jie® «e® 

mG‘^: 


^”°u°+ 2 ^'”-'y,+ 2 ‘^75"+ 2 ^r^" = er 

ye® »e® »e® 

and these may be combined into the single matrix equation of the form Ax 
shown in Eq. (63). 


(58) 

(59) 

(60a) 

(60b) 

(61a) 

(61b) 

(62a) 

(62b) 

(62c) 

(62d) 
B, as 
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s 


PI 

PI 

g® 






1 A°j 

1 2 

1 

2 

Mi 


1 

1 me^f 

1 

me<S 


(3 X 3) 

! (3X/.J 

1 (3X1V„) 

1 

1 

OxNJ 

WM 

A^ 

' A‘j 
1 

: 

* m 

1 

I 

lAr 

m 



1 («« X nj 

l<5. 


1 

j_ 

(«, X NJ 


^mO 

err 

' 2^ 

1 

1 

2^7 



1 

n 


1 

ft 


X 3) 

1 {N„ X n„) 



1 

(_^m X N„) 

,.v-> 

(SjJinO 

J <5j)”V 

1 2 
n 

1 

1 

2 

n 

:• '-i 

(K X 3) 

1 X n„) 


xN„) 

1 

1 

(^« X N„) 

c % 







il 







■V.-sJSfJ, 

"v i? i-’-'X'* 


2 C°*£* 







ke'i 







(3x1) 







1 e,*C‘*£*-^r, 





kS9 





'*:1 

S3 


('>, X 1) 







Qr 





•‘‘•'•.'rvA* 


(A^«X 1) 







Qr 







(^« X 1) 






— 


— 





<*) 

_(3x 1_)_ 

yj 

J ^ P 

S” 

V” 

(N„ X 1) 


(63) 


Except for 6B™, S™. when m = n, the elements of system matrix 

A are, in general, time-variable. Note also that, if the appendage equations are 
multiplied through by the factor 2, matrix A becomes symmetric. 

B. Subroutine MBOYFR 

Equation (63) provides a complete set of rotational dynamics equations which 
lend themselves to solution by means of a generic computer program or subroutine 
for the rotating appendage case. When augmented by the rotor equations, control 
equations, and kinematical equations, they are fully descriptive of the system 
behavior. 

The kinematical variables adopted in the preceding sections are as follows: for 

* e <3* (Def. 23); C'^ for r, / E ^ (Def. 31); and «° = {b°} • (Def. 9). Although 
the equations of motion have been expressed in terms of these quantities, the latter 
are not all independent. Relationships among kinematical variables developed in 
this section must therefore either be considered in conjunction with the dynamical 
equations or be substituted into them to remove redundant variables whenever a 
solution is sought. 
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The direction cosine matrix (Def. 31) relates sets of orthogonal unit vectors 
fixed in and 4j, and hence depends upon those angles for which /*„ lies 
between and 4j, and also upon the corresponding unit vectors g“ defining the 
intervening hinge axes. For the special case in which 4^ and 4j are contiguous and 
j < r, it is alw_ays possible to express C/"' (and C^'') in tenns of the single angle 7 , 
and the single matrix g', as follows: 

C'j = U cos Y, - g' sin y, + ~ cos y,) 


and 


O' = U cos y, + g' sin y^ + gY\^ ~ cos y,) = 

It is only required that C'^ be determined where 4^ and 4j are contiguous and, 
since to then derive matrices C°' for rE9. An algorithm for 

accomplishing this task is described in Ref. 6, Appendix A. 

The Fortran V subroutine, called MBDYFR, which provides the solution to Eq. 
(63), has been designed in much the same form as those subroutines described in 
Refs. 6 and 7. The routine may be exercised by means of either of two call 
statements. An initializing call statement supplies the routine with data that will 
remain constant throughout the dynamic simulation run. 

The description which follows of the subroutine initialization statement includes 
some new variables which will now be defined. The use of these new variables is 
necessitated by the desire to make the subroutine MBDYFR more efficient. 
Therefore, the convention (described in Defs. .1-4) of labeling the system’s rigid 
bodies from 0 to n, where each connection between bodies is a line hinge, will be 
modified. Rather than introduce imaginary massless bodies at connections with 2 
or 3 degrees of rotational freedom, these types of connections will be handled 
directly by the routine and no new bodies will be introduced. 

Def. 45. Let be the number of connections joining a set of + 1 substructures. A 
connection is a 1-, 2-, or 3-degree-of-freedom joint at which all the 
rotational axes share a common point. The axes need not be mutually 
orthogonal. 

Def. 46. Define the integer set = {0, 1, . . . , 7 ?^}. 

Def. 47. Define the integer set { 1, 2, . . . , n^}. 

Def. 48. Let be the yth neighbor set for /£%'■, such that kE%'j if is 
attached to 4j. 

The rigid body labeling process is to be carried out precisely as prescribed in 
Def. 4, except that the last label will be 4^ rather than 4^. Note, however, that the 
connecting joint degrees of freedom are still labeled from 1 to n, so that one still 
has y,, Yj, . . . , y„ and g', g^, . . . , g" (The joints must be in the sequence corre- 
sponding to the body label sequence, as shown in Fig. 2). All references to the “kth 
substructure,” when applying the MBDYFR subroutine, imply that ke S'. 

Def. 49. For kE‘5"', let denote the index label of the body attached to 4^ and 
on the path leading to The scalars will be termed “connection 
elements.” Thus, it is always true that 4, = 0. 
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Fig. 2. An 8-body, 10-blngo system Illustrating 
tho labeling convention 


Def. SO. Let < 4 , k G denote the number of degrees of freedom at the A:th 
connection. 

It is also necessary, when applying the subroutine, to relabel each of the nonrigid 
appendages in the same sequence from 1 to nj (see Fig. 2) so that the labels 
become . . . , 

Def. 51. Let ry be the number of nonrigid appendages in the system (no more than 
one per substructure). 

The first column of the input array, F, contains the index labels of those rigid 
bodies to which nonrigid appendages (J, (/ = 1, . . . , nf) are attached. 

Initializing Call Statement 

CALL MBDYFR(NC, H, MB, MS, PB, PS, G, PI, 

NF, F, ER, El, SR, MF, RF, WF, ZF) 

where 

NC= the integer n^ = number of system connections (see Def. 45). 

H(/c, m) = array containing the connection elements k E and the 
number of degrees of freedom, d^, at the connection; m = I, 2. 
(H(l, 1) = A„ H(2, l)=/*2, . . . , H(/i„ l) = /4„, H(l, 2) = J„ 
H(2, 2) = dj, . . . , H(n„ 2) = d^.) 

MB(J) = array of undeformed reference substructure (/q) inertial con- 
stants y = 1, . . . , 7. (Specifically: MB(1)=7|°, MB(2) = > 

MB(3) = /3°3, MB(4)= -/°2, MB(5)= - J°3, MB(6) = -7^3, 
MB(7) = <D1L„.) 


26 


JPL TECHNICAL REPORT 32-1598 



MS(i,y) = array of remaining substructure body (undeformed) inertial con- 
stants; i e = 1, . . . , 7. (Thus: MS(/, 1) = MS(/, 2) 

= , MS(/, 7) = <DII,. 

PB(i,y) = array containing elements of p°'\ i E j E 1, 2, 3. 

k) = array containing elements of p'J; i E 6^', jE ^ = 1, 2,' 3. 
(Exception!! If y < i, set PS(j, /, k) = p'j. Example: PS(3, 3, 1) 
= All PS(i,y, k), where y < /, will be ignored.) 

G(i,j) = array containing elements of g'; / £ 6 * ,y = 1, 2, 3. 

PI(0 = array of indicators; / = 1, 2, . . . , n + 1. (If Y/ is a prescribed 
variable, PI(/)= I- Otherwise, PI (0 = 0. ^Mso, if PI(/i + 1)= 1, 
system angular momentum HM will be calculated; otherwise; 
HM is set to zero. 

NF = the integer n, = number of substructures with nonrigid appen- 
dages = number of nonrigid appendages. 

F(n, m) = array containing the index labels of those rigid bodies with 
nonrigid appendages, the number of nodal bodies in each appen- 
dage’s finite element model, and the number of modes to be used 
in each appendage’s modal model; n = 1, 2, . . . , m = 1, 2, 3. 
(Thus: 

F(1 , 1) = index label of rigid body carrying appendage 
F(1 , 2) = number of nodal bodies in appendage ffi, 

F(1 , 3) = number of modes representing appendage (J, 

F(2, 1) = index label of rigid body carrying appendage &2 


etc. 


F{rip 3) = number of modes representing appendage &„p) . 


ER(n, 

i,J) = array of elements 

of n = 1 , 2 , . 

, .,rip / = 1, 2 , . , 

. , 6«*; 


k = F(/i, l);y = U 2, 




EI(n, 

j,y') = array of elements 

2 . 

II 

. . , ttj, / — 1, 2y . < 

. . , 


k = F(n, l);j= 1, 2, ... , A*. 


SR(/i,y’) = array of substructure nominal spin rates, Q*, ^ = F(n, 1); 
n = 1, 2, . . . , n^;y= 1, 2, 3. 

MF(n, i,j) = array of nodal body inertial properties, M*, for each nonrigid 
appendage; n = 1, 2, . . . , i = 1, 2, . . . , /c = F(/i, 1); 
y = 1, 2, . . . , 7. (Example: MF(2, 3, 1) = /f„ MF(2, 3, 2) = 4, 
MF(2, 3, 3) = 4, MF(2, 3, 4) = .... MF(2, 3, 7) = m 3 , all 

for nonrigid appendage ffj, third nodal body.) 


RF(n, i,j) = array of elements of r,^, k = F(n, 1), for each nonrigid appen- 
dage; n = 1, 2, . . . , tif, / = 1, 2 «*. y = 1. 2, 3. (Example: 

RF(1, 5, 1) = r\, RF(1, 5, 2) = r\, RF(1, 5, 3) = r\, all for ap- 
pendage £,.) 

WF(/7,y) = array of modal frequencies, 5*, k = F(/i, 1), for each nonrigid 
appendage; n = I, 2, . . . , rij,j =1,2,..., 

ZF(n,y) = array of modal damping factors, |*, k — F(n, 1), for each nonri- 
gid appendage; n = 1, 2, . . . , tij,j =1,2,..., N^. 

The statement CALL MBDYFR (NC, H, . . . ) need only be executed once prior 
to a simulation run. However, as the simulation proceeds, the routine must be 
entered at every numerical integration step to compute the angular 
accelerations <o°, y,, . . . , y, and the modal coordinate acceleration vectors 6* and 
Tj* {k E This is accomplished by executing the “dynamic” call statement. 

Dynamic Call Statement 


CALL MRATE(NC, TH, TB, TS, FB, FS, TF, FF, GM, GMD, GMDD, 

DT, ET, WO, WDOT, DTD, ETD, HM) 

where 

NC= the integer n, = number of system connections. 

TH(0 = array containing the hinge torques, t, ; / G 0* . 

TB(y) = array containing the elements of T® ; y = 1, 2, 3. 

TS(/,y) = array containing the elements of T'; i E 6*'',y = 1, 2, 3. 

FB(y") = array containing the elements of F° ; y = 1, 2, 3. 

FS(/,y') = array containing the elements of F' ; i G ^',j = \, 2, 3. 

TF(n, i,j) = array containing the torque elements of \* ; n = 1, . . . , /y, 
k = F(«, 1), / = 1, . . . , i»*,y = 1, 2, 3. 

FF(n, /,y) = array containing the force elements of ; n = 1, . . . , 
k = F(/i, 1), » = 1, . . . , n*,y = 1, 2, 3. 

GM(i) = array of angles, y, ; / E *3* . 

GMD(0 = array of the angular velocities, y, ; / E *3* . . 

GMDD(0 = array of the prescribed angular accelerations, y, ; / G . 

DT(n, /) = array of appendage modal coordinates, 5 *; /i = 1, . . . , /i^, 
k = F(«, 1), / = 1, . . . , N,. 

ET(n, /) = array of appendage modal coordinates, n — I, . . . , n^ 
k = F(«, 1), / = 1, . . . , iV*. 

WO(y') = array containing the components of w° ; y = 1, 2, 3. 

WDOT(y) = solution vector containing the elements of w°, yi, . . . , y„; 

y = 1, . . . , n 3. (WDOT(l) = w?, WDOT (2) = WDOT (3) 

= «?, WDOT (4)= y„ . . . , >^^T (n-H 3) = y„.) 

DTD(n, 0 = solution matrix for 5* ; n = 1, . . . , ti/, A: = F(/i, 1), / = 1, . . . , 
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ETD(n, 0 = solution matrix for ; n = 1, . . . , A: = F(/j, 1), / = 1, . . . , iV^. 

HM » magnitude of the system angular momentum vector (see Appendix 
B for the momentum equations). 

In summary, the call to MRATE supplies the subroutine with current instan- 
taneous values for hinge torques and externally applied torques and forces on both 
rigid bodies and nonrigid appendages. Explicit expressions for computing these 
forcing functions, which may depend on y,, y,, and other system or control 
variables, are located in the ' main calling program (see sample problem that 
follows). Current values of <a°, y,, y,, fi*. and ij* are continuously produced by the 
main program’s numerical integration operators and are therefore always available 
for input to MBDYFR. 

It should be noted here that MBDYFR does not incorporate the terms in Eq. (42) 
that describe symmetric rotor torques on body As a. result, the user is required, 
if rotors are present, to supply these terms as part of a “new” T*, i.e.. 

Thus, these terms must be formed in the main program along with Eq. (44), and 
T'* is supplied to the subroutine as TB (if A: = 0) or TS in the MRATE call 
statement. 

Note also that, if any of the y, are to be prescribed, the appropriate values of y„ 
y,, and y, must be supplied to the subroutine by way of GM, GMD, GMDD, 
respectively, in the MRATE call statement. An example of this is shown in Section 
IVC. 

When the MBDYFR subroutine is used, the main calling program must contain 
Fortran V (or IV) statements which specify “type” and allocate storage for the 
variables and arrays being used. The mandatory specification statements are listed 
here. 

Required Specification Statements 

INTEGER NC, NF, H(«^, 2), F(/i^, 3), PI(;i + 1) 

. REAL MB(7),MS(n„7),PB(/»„3),PS(/i„n„3),G(«,3), 

TH(«), TB(3), TS(n„ 3), FB(3), FS(/i„ 3), GM(n), 

GMD(n), GMDD(«), ER(/y, 6n^, N^), El{np N^), 
MF(«^, n„ 7), RF(n/, n„ 3), WF(/i^ N,), ZF(/.^ N,), 

TF{np /»*, 3), FF(n^, n*, 3), DT(/y, N^), ET(n^, N^), 

WO(3), SR(n^ 3) 

DOUBLE PRECISION WDOT(n -t- 3), DTD(/?^ Nj, ETD(n^, iVj 


Also, in order that storage allocation for arrays internal to MBDYFR be 
minimized, the following statement must appear in the subroutine'. 

PARAMETER QH = n, QC = n„ QF = n^NK = /»*, NKT = W* 




The proper placement of this statement in MBDYFR is shown in the listing 
(Appendix C). 

C. A Sample Problem Simulation 

To illustrate the use of subroutine MBDYFR, the dynamical system shown in 
Fig. 3 will be simulated. It consists of a rigid central body, /g, to which is. 
connected a rigid platform, /j* with 2 degrees of rotational freedom relative to /g. 
A spinning rotor, is also connected to . The platform and the rotor each 
carry an elastic appendage, which will be modeled as a simple point mass 
supported by a massless elastic member. 


For this test vehicle, the platform will be nominally nonrotating, while the rotor 
will have a nominal spin rate of about the spin axis fixed in ^g. The appendage 
modal models must now be derived from the appropriate discrete coordinate 
equations. 

Rotor Appendage Equations 


The general appendage equation is Eq. (17), where the matrices Gj^, and K'^ 
for the rotor substructure are as follows: 




■SI 


A/' = 


m^ 

0 

0 

0 

mi 

0 

0 

0 

'Wi 


0 



A/,' = M>(c/-2„g2^;g^) = 


where 


0 


I 
I 
I 
I 

1 _ 

' 0 
I 


Ml = "»i - 




(6x6) 


Ml 

0 

0 

0 

Ml 

0 

0 

0 

Ml 


0 



I 

I 

j _ 


(6x6) 




9!L = 

0Tlg+ 

+ . 


The rotor spin rate = = [0 0 



- 

■ 

0 

-«,Mi 

0 1 

v}- 

■ 

G[ = 2 

«,Mi 

0 

0 |o 



0 > 

0 

0 ' 
— 1- - 

SI 



0 

' 0 
1 


(6x6) 
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0 

0 1 

0 

^2 

o 

O 

0 

0 

*3 ' 


0 

_ L _i _ 

' 0 
1 


(6x6) 


where k^, k^, and k-^ are the respective-stiffness coefficients which restrain linear 
motion in the b{, b‘, and bj directions. Thus, 


*1 - 

0 

0 

1 


0 

*2 - 

0 

1 

0 

0 

0 

1 

1 

1 

1 



0 


1 

0 
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The homogeneous rotor appendage equation may therefore be written as 


f*I 

O 

O 

1 


0 

- 

0 

0 

0 

+2 

"iMi 


0 0 

0 

0 fi, 


0 


0 0 


Ar, - /i,u/ 

0 

0 


+ 

0 

^2 


0 

o 

II 

"V 


0 

0 

^3 



where q' = [uj i/j (realizing that = = P\ = 0, since m, is a point mass). 

If the equation is rewritten in first-order form, as in Eq. (18), it becomes 

*^1 e ' + % e ' = 0 

where 


k, - «//i, 

0 

0 




0 

*2 - 

0 


0 


0 

0 

1 

1 

|u 

1 

1 

0 

0 


0 


1 0 

Ml 

0 




1 0 

0 

Ml 





1 

- *1 + “/Mi 

0 

0 



0 



0 

-*2 + «/Mi 

0 

* 





0 

0 

zh- 


Ac, - w>i 

0 

0 


0 

- 2w,Mi 0 



0 

kj - «//l, 

0 

1 

2«,Mi 

0 0 



0 

0 

^3 


0 

0 0 




and 

The rotor appendage equation eigenvalues, and corresponding eigenvectors, 
$-{, may then be found from 
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From the characteristic equation, one finds that 



and 



where /c = A:, = /cj. 

If we now arbitrarily let = 2w, and Mi = 5<o,, the eigenvalues be- 

come 

X, = iw, 

Xj = i3w, 

Xj = iSw, 

X4 = - iw, 

Xj = — /3w, 


Xj = - /5w, 

Note that the eigenvalues are imaginary as predicted and that they have been 
deliberately ordered to correspond to the form of Eq. (22), with conjugates in the 
lower half of A,. 


The eigenvectors corresponding to these eigenvalues may then be determined as 


% 


Also, 


i — i 

1 1 

0 0 

- «, 3w, 

iw, i3u, 

0 0 






0 -i i 0 

0 110 

1 0 0 1 

0 — 3«, 0 

0 — iu, — i3uj 0 

i5w, 0 0 — i5u. 


24p|<d/ 0 

50p,«/ 

8ju,w/ 

0 24p,«/ 




50/i,«2 
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SI 


The final form of the appendage modal coordinate equations, shown in Eq. (26), 
can be obtained only if the eigenvectors are normalized so that = U, the 

diagonal unit matrix (see Ref. 3). Thus, succeeding columns in should be 

multiplied by (8p,<ij,^" (24fi,w/)“ (50/i,«,^)“ S etc., for proper normalization 

in this case. 


If we also arbitrarily truncate this modal transformation to just the first two 
modes, the resulting real and imaginary parts of <l>{ become 


•iiW-S! 

w 


'('l 


Likewise, 


n 

A 


1 

1 

1 

v 

1 

. r,= 

2«,v5m7 

2«,v^ 

2<d,V5^ 



0 

0 

9 

0 3<o, 

. I' = 

?>' 0 
0 





Platform Appendage Equations 

If the same process is applied to the nominally nonspinning platform appendage, 
its homogeneous equation of motion becomes 



Ih 

0 

0 



0 

0 

.•■L'V's 

< 

i » 

0 

Ih 

0 


0 

*2 

0 


0 

0 

Ih 


0 

0 

*3 




Using the first-order equations again, 

%iQ^+%Q^ = 0 


where 


9^ = 0 






k^ 0 
0 k2 
0 0 


0 
0 

A J 


0 

Q 


0 0 
Ih 0 
0 M2 
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1 


0 

0 


0 

1 

1 

0 

~^2 

0 



1 

1. 

0 

0 

.-Jl 

*1 

0 

0 ] 


•- 


0 

fej 

0 1 


0 


0 

0 

*3 1 





one can easily determine that the eigenvalues are 



If we let k = kx = ki = k^, and w/h ~ ®2> 


and 


Aj = 


®2» 


a,/ 


a -,1 


-Oil 


-Oil 


-Oil 




1 

0 

0 

02» 

0 

0 


0 

1 

0 

0 

®2' 

0 


0 

0 

1 

0 

0 

Oii 


1 

0 

0 

-®2' 

0 

0 


0 

1 

0 

0 

-<72/ 

0 


0 

0 

1 

0 

0 

— Oii 
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The appropriate normalization factor for each is (2^2®!)”'- Thus, if the 
platform appendage modal model is truncated to the first two (transverse bending) 
modes, the needed quantities are 



0 

1 



5' 


®2 

0 


0 

®2 




if 

0 


0 

if 


Test Vehicle Constants 

To complete the specification of the test configuration shown in Fig. 3, numeri- 
cal values can now be assigned to its various mass properties and other physical 
constants. First, let 


=» 399.9 kg 
91L, = 50.1 kg 
%2 = 50.0 kg 

OT, = 1.0 kg 

mj = 5.0 kg 


P 



250. 

0 . 

0 . 


0 . 

275. 

0 . 


0 . 

0 . 

350. 


, kg-m^ 



0 . 0 . 

10 . 0 . 

0 . 20 . 


■ 

, kg-m^ 


.’. 9IL = 011, + 91L, + 01 I 2 = 500.0 kg 


.-. /i, =.998 kg 


p4 = 4.95kg 
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Also, let 


u, = 10. rad/s, {l = ^i= 01 
02 = 9. rad/s, |f = |2=.oi 


0 

0 

. Ti = 

.035391 

- .020433 

.035391 

.020433 


0 

0 

.035313 

0 

. T2 = ( 

3 


0 

.035313 





The locations of the two point masses (see Figs. 4 and 5) relative to their 
substructure’s mass center when they are in the nominal deformed state will be 
assumed as 


r, = [.33 0 —.493]^ meters 

/•j = [0 0 .56]^ meters 


t-' 
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Locations for the interbody connections, relative to substructure mass centers, 


are 

/‘ = [o. 

0. —2.]^ meters 


II 

8 

j» 

1. 1.] meters 



0. 0. ] meters 



— .3 0.] meters 


The three hinge directions are given by the direction cosines 


Also, 



rotor : 


= [0. 

0. 

i.r 


platform : 


= [0. 

0. 

l.f 


platform : 


= [1- 

0. 

O.f 

He “ 2, 

= 2, n, ^ 

= 1. 

«2 = 

1, 

= 2, 

h, = 0, 

fi2 = 0, d, 

= 1, 


2, n = 

= 3 


As a result of these choices, the initializing call statement arguments become 

NC = 2 


H 


0 1 
0 2 


JPL TECHNICAL REPORT 32-1598 


MB = 

[250. 

275. 

350. 

0. 

0. 

0. 

399.9] 



MS = 

10. 

10. 

20. 

0. 

0. 

0. 

50.1 




- - - 

6. 

3. 

8.- 

0.- 

0. 

0.- 

50.0 

- --- 

- -- - - 

- 


PB = 


0 . 

0 . 


0 . - 2 . 

1 . 1 . 


PS(2, 2,j) = [0. - .3 0. ] (all other PS elements are zero) 


G 


0 . 0 . 1 . 

0 . 0 . 1 . 

1 . 0 . 0 . 


PI = [0 0 0 1] (assuming no prescribed hinge motions) 


NF = 2 



' ER(1, /,;•) = 


0 . 

.035391 

0 . 

0 . 

0 . 

0 . 


0 . 

.020433 

0 . 

0 . 

0 . 

0 . 


EI(1, i,j) = 


.035391 

0 . 

0 . 

0 . 

0 . 

0 . 


- .020433 

0 . 

0 . 

0 . 

0 . 

0 . 
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.035313 0. 

0. .035313 

0 . 0 . 

0 . 0 . 

0 . 0 . 

0 . 0 . 

EI(2,/,;) = 0. 

0 . 0 . 10 . 

0 . 0 . 0 . 

MF(1, l,y) = [0. 0. 0. 0. 0. 0. 1.0] 

MF(2, l,y) = [0. 0. 0. 0. 0. 0. 5.0] 

RF(1, \,j) = [.3333 0. - .4930] 

RF(2, \,j) = [0. 0. .56] 

10. 30. 

9. 9. 

zyJ o* 

.01 .01 

Test Vehicle Dynamics 

Before simulating a specific dynamic case for the test vehicle of Fig. 3, the 
characteristics of the interbody connections must be defined. The connection 
between /g and rotor / , will be assumed a frictionless bearing so that 

T, =0 

The platform hipge connections will be assumed to be of the linear spring- 
damper type, i.e., 

^2 = - ^2(Y2 - Y2r) - 

'’■3 “ ~ ~ y^c) ~ ^iyy 
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where and Ysc platform angular position commands. The values of the 
constants K 2 , K^, Bj, are arbitrarily chosen as 

/fj = 250. n-m/rad, ^2 ~ 50. n-m-s/rad 

/lj = 300. n-m/rad, flj = 50. n-m-s/rad 



The dynamic response to be simulated here will be that due to a high-rate 
platform slew sequence. Slew commands Yjc Ysc "'HI 1^® generated by integrat- 
ing the time functions shown in Fig. 6. This will result in a 10-deg rotation about 
and a 10-deg rotation about g^. 

Initially, the rotor is spinning at 10 rad/s relative to and the rotor appendage 
is at rest relative to the rotor but deflected radially outward in its steady-state 
deformed position. (One can show from Eq. (17), with the assumption k/ /i, = 4w/, 
that the radial deformation (in the b| direction) due to spin is r^/2, where is the 
distance from the rotor spin axis to the appendage attachment point.) The plat- 
form, ^|, as well as the base body, /q, are initially at rest. At / = 1 s, the command 
is issued to rotate the platform about g^ at a rate of 10 deg/s until / = 2 s; again at 
/ = 3 s, a command to rotate about the g^ axis at 10 deg/s appears and ends at 
/ = 4 s. The computer simulation program, employing MBDYFR, for this dynamic 
maneuver is shown in Fig. 7. 

Notice that the necessary dimension specifications for each variable are stated in 
the JPL CSSL III simulation language as; ARRAY MB(7), MS(2, 7), . . . , etc. 

An auxiliary routine, called HCK, is used in the simulation to keep track of the 
rotations of the reference body (<^q) relative to an inertially fixed frame. HCK uses 
Euler parameters to do this, and it is initialized using Euler angles. The variable, 
THET, is calculated in the program by means of HCK and represents -the angular 
deviation of the bj axis from its initial, inertially fixed position, i.e., the reference 
body “nutation” angle. 

The CSSL III function, “STEP,” provides the unit step function when the 
independent variable, TIME, is greater than the specified constant. 
“INTEG(a,, flj) signifies the integration of a, with respect to TIME, where Oj is the 
initial condition. 





Fig. 6. Commanded slew rates 
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CSSL m jet propulsion laboratory 0R037H»A002h 02J775-021436 

••• ST*RT T(RUN,« 28,032 T(TaSK). .003 CTP ■ ,7aO 

DT(TASK>« .003 OCTP • ,740 

program 3-bOOY vehicle RtTH SPINNING ROTOR AND 2 FLEXIBLE APPEN0A«ES 
•SCH020 BL0G/l98,80X/40l ,C *MER A/9 I N , FRAMES/50 

array MB(7).MS(2.7).PB(2.3t,PSI2,2,3ItG(3|3)tTH(3).Ta<3),TSI2>3) 
array FB(3) ,FS(2 .3) ,SM(3) .GHd(3 I .GMDo<3> .ER(2.6,2>,EI<2.4,2) 

ARRAY MF<2, I ,7) ,RF(2i j .3» .mr I2,2» ,2ri2,2 » ,TF12, 1 ,3) ,FFI2 ,l ,3) 
array SR(2.3),0TI2.2I.ET<2.2).W0I3),U<2i1i3),U0|2,|,3) 
double precision W00T(6» ,0Tdi2,2) ,ETd( 2.2» ,EC<m 

INTEGER NC,NF.h(2.2>.f<2.3|,pi(9) 

data H/0,0, 1 ,2/Pl/0, 0,0,1/ 

data Ma/2S0..27S.,3S0.,0,,0*,0*,399.9/ 

DATA MS( > ,1 I/10./MS< t ,2)/tO,/HSl 1 , 3 I /2o , /MS (I 1 7 I /SO , 1 / 
data MSI 2 , 1 I /4. /MSI 2,2 I /3, /MS I 2,3) /B. /MS I 2,71 /SO,/ 

Data pbi t , t ) / o./pb u , 2 >/o,/pb 1 1 ,3)/>2,/ 
data PB I 2 , I ) /0,/P8(2.2>/| •/PBI 2i 3 ) / 1 ,/ 

DATA PS(2,2,1)/0,/PS(2,2.2)/>.3/PSI2,2.3)/o,/ 

DATA G<1,3I/1,/G(2.3)/1./G(3,1)/1./ 

Data f/ i , 2 , i , i , 2 , 2 / 

DATA ER<l,2il )/,03S39 o 7S/ER( l ,2 , 2 ) / , 02oN328B/ 

DATA Ein.l.l I/,o3539o75/EH 1 , 2 ) /- .0209 32 84/ 

OAT A ER|2, I . I )/.03S3 J3H3/CR( 2,2,2 ) /.035« 139 3/ 

OaTa RFI I , 1 , 1 I / .3 333/rF ( i,l,3)/«.H9 3Q/RFl2,l,3)/.S4/ 
data Mf U , I ,71/1 ,0/«F|2,» ,7)/5,0/ 

OATA ZF< > I I 1 /.Ol /ZFI I .2>/,01/ZFI 2, 1 ) /.ol /ZF (2,2 ) /,0I/ 

OATA WFI 1 . 1 I /IO./RFI i , 2 1 /3Q. /«»F ( 2 , I 1 /9 , 0/WF I 2 , 2 ) /9 ,0/ 

OATA SRll ,11/0. /SRI 1 ,2»/0,/SRU ,3)/10*/ 
constant K2«2S0, .b2«S0« •K3s300, »B3*50> 
constant TFINaL«10« »CLX7|M»900. • pi E»3, 1 9159245 
constant PHIZ-O, .THET2»0.,PS1Z»CI, 
constant GM10I>10. ,W| I»0« •«21>0, ,W3t aO. 
initial 

NC «2 S NFa 2 

Call mboyfr(Nc.h.m 8 ,ms,pb,ps.g,pi ,nf,f,eR,ei ,sr,mf,rf,"f,2f) 

PZI,PAI,PBl,PC|aHCX(INlTL,PHlZ,THETZ,PSIZ) 

end 

dynamic 

IF I T IMe.GE.TF INALI GO TO Si 
derivative B00Y3F 

Variable timebo. s cinterval cia.oi 

XERROR Rial ,E>9 ,W 2 a 1 .e-9,W3b 1 .C'9,GM2Da I •E<*9,GM30a I ,£*9 , . , , 

GMZai ,E-9 ,GM3ai ,E>9 ,PaD"I •E>9,P80b 1 ,£’■9 iPCOal .E*9,6M| ■! ,C-S 
MERROR W|"l.E-9,»(2"l ,F-9,*3al .C>9,GH2Dal.E-9,GH3Da|>E~9,,,, 

SM2ai .E-9,QM3ai ,C-9,PA0ai ,E-9,P0Oal , E«9 J PCO a 1 , E b 9 , GM I a i ,£,5 
STPCLK CLKTIM 

OUTPUT lO.Wlo ,w2d , n3o.W> ,R2,W3 ,6M1 0 ,6M20,GM30 iGMI ,GM2 ,GM3 ,THET , , , , 
0T1a,0tIB,0T2a,0T2B,ETIAiETIB.ET 2A,ET2B,PZ0.PA0,PB0,,,, 
PC0,UlX,Uir.UlZ,U2X,u2Y,U2Z>UiXD,U)YD,U2X0,U2Y0,6H2C,.., 
GM3C ,GH2 CD.gN3C0 ,aNGM 

PREP A R THET.RI .W2,W3,gM10,GH2D,GM3d,6M2,GM3 . U 1 X , U I Y , u2x , U2 Y • , , . 

GMI ,U1X0,U1y0.U2X0.U2YD,GM2C ,GM3C ,ANGM 

NOsoRT 

WOlllaRl S W0(2)aw2 s R0(3|.W3 
GMI|)a(;M| S GM|21aGM2 S GM(3).qH3 


FI 9 . 7. Slmulitlon program for test vehicle dynamics using MBDYFR 


original 

OF POOR QUALITY 


4a 
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GKOtHaGHlo % G"0(2)asM2o t GHo(3)*6M3o 

DT(J ,n«OTU S OTtl i 2 >*OTlB S ET«J.n«ETl* S ETUi2I«ETIB 
0TI2,1)*0T2a s 0T(2,2)"0T2B % ET(2.1)"ET2A s ET ( 2 , 2 ) ■ET2B 
COhhENT, , , 

platform position commands 

COnmEnT 

6M2CD«(STEP( 1 <0iTIME|«STEP |2.0,TIME M*PlEa|0>/l80» 
6H3CD«(STEP(3«OiTlHE).STEP(<t.O*TINE>)*PIE*tO«/180< 
6H2C"lNTCa(GH2COiO* > * GM3C* t NTEG ( GM3CD lO • i 

COMHENT.i. 

Reference boot nutation a'<<>le 

comment 

0| iD2aHCK(HATRlX,fZ0,PA0,PB0.PC0) 

OCt •0C2.0C3aHCK(8T0I .0< >0« 1 1 « .0 1 iD2 } 

0CMaSQRT(DCl**2 * 0 C 2 ** 2 ) 

THET>ASIN( DCM) alSQ./PtC 

conment, . . 

hinge torques 

comment 

THI2l«aK2*(GM2>GM2CI a B2*SM2D 
TH(3laaK3*(GM3aGM3C) a B3«GM30 
CONMENTxi 

STSTEM angular ACCELERATIONS 

comment 

CALL MRATEINC.TH.TB tTStFB |FS ,TF ,FF ,6M ,GMD ,GMOO ,OT,ET , HO, ROOT , t .. 
OTO,ETO|HM,U.UO) 

U1X0«U0( i t I « 1 ) S U|roaUO(}(|, 2 ) > U2X0aUD(2»l >1) * U2TD-UD ( 2 , 1 ,2 I 
U|X«U<l«til> B UIYaU(|ili2) t UlZPUI|i|,3) 

U2XaU<2ttill a U2YaU(2(l(2) t U2ZaUl2tti3> 

RlOaWOorm t R20aRO0T(2) s W30«R00T(3) $ ANGMaHM 

COmMENTxi 

SYSTEM angular rates AND POSITIONS 

comment 

RIaINTEOIRDOTI I ) .R1 I ) 

R2>INTeGIRoOT( 2) ,R2> t 
•3 »|NTcgIR 00T(3» ,R3l I 
GM|OaINTEG(ROOT(<n .GMiOI I 
GN20alNTEG(R00T(S) .O.) 

GM3oaINTEG(RoOT(6l .0, ) 

GMla|NTEG(GMIOiO«l * GM2« I NTEG ( GM2D lO t ) S GM3* I NTEG I 6M30 ,0 t i 
OTI AalNTEGIOTOl I , 1 ) lO. I > OT I Ba | NTES I DTP ( 1 . 2 I • 0 • I 
0T2Aa]NTEG<DTO(2i 1 ) lO. I > 0 T 2 B*| NTEC ( DTD ( 2 , 2 ) . 0 • ) 

ETJA«INTEG(ET0nf|).0.» » ET 1 8»I NTeG I CTO H . 2 ) , 0 1 ) 
CT2AalNTCG(ET0<2iI I lo.l • ET 2 B-I NTCG I ETD ( 2 1 2 > * 0 t » 

comment... 

HCK Parameter RaTes and positions 

comment 

PZOD .PaOO.PbOO .PCOOaHCKIHCK.PZO.PAO.PBO.PCo.Wl .N2 .N3I 
PZOaINTEG|PZOO|PZM S PAQa] NTEG ( PAOO ,P A I ) 

PBOaINTCGIPBOO.PBI I S PCOa | NTCG ( PCOO , PC I ) 

end 

end 

end 

terminal 

Sl.t CONTINUE 

end 

END 


Fig. 7 (contd) 
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All arithmetic statements are in Fortran, although CSSL III allows several 
statements in a single line if separated by a Variables to be plotted at every 
communication interval, Cl, are listed in the PREPAR statement. Printed variables 
are listed in the OUTPUT statement. 

The statement “CALL MBDYFR(NC, H, . . . )” is located in the INITIAL 
section and is therefore executed only once, i.e., prior to the dynamic calculations. 
However, “CALL MRATE(NC, . . . )” is in the DERIVATIVE section and is thus 
executed at every integration step. Note that two additional output variables have 
been added to the MRATE call statement argument list. They are U and UD, 
containing the appendage deformations uj, u^, uj, Up . . . etc. and the deformation 
rates «}, lij, . . . , respectively. These variables are always available internal to 
MBDYFR using the relations of Eq. (27) and are outputted here only to more 
clearly illustrate the dynamic response of the system. (P\, . . . , fi\, . . . etc. 

could also be obtained from the subroutine in those cases where the appendage 
nodal bodies have inertia.) 

Results of the dynamic simulation are shown in the computer plots of Fig. 8, and 
the sample printout is presented in Fig. 9. 

The solutions show, as expected, that all three components of the reference body 
angular velocity, <a°, are strongly perturbed by the platform as it accelerates or 
decelerates. Further, induced vibrations of the platform appendage are also in 
evidence on the reference body rates. Rotor spin rate, y,, relative to remains 
very close to its initial and nominal value of 10 rad/s, although the effect of 
slewing the platform about an axis parallel to rotor spin is quite evident as are the 
subsequent vibrations due to platform appendage motion. Platform hinge rates, yj 
and yj, also show some appendage vibration, although it is very small compared to 
the slewing rate transients. 

The components of rotor appendage deformation uj, exhibit both modal 
frequencies, w, and 3«,, but are relatively small in amplitude compared to the 
platform appendage deflections uj, «|. An “X- Y" plot of the platform appendage’s 
deflections relative to its locally fixed coordinate frame is also shown. 

System angular momentum magnitude in this test simulation should remain 
constant since no external forces or torques are being applied. The plot of HM 
shows this to be true very closely. Small deviations from a perfectly constant 
angular momentum in the simulations are to be expected due to the presence of 
modal damping (see Appendix A), numerical integration error, and round-off error. 

N76 12094 

IV. Systems With Nonrotating Appendages 

A. Equations 

In Part III, dynamical equations were developed for the substructure tree on the 
basis of (1) arbitrarily small flexible appendage deformations (and rates) from some 
nominal state and (2) arbitrarily small deviations of the angular rate of any rigid 
appendage base from a constant nonzero spin rate, 12*. In this section, the 
assumption will be made that = 0 (k E i.e., that the appendage bases are 
nonrotating. 
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Fig. 8. TmI vclileto (wHh spinning rotor) sImulaUon mutts using MBDYFR 


JPU TECHNICAL REPORT 32-1598 















GM2C, rj^ GM3C, 




























r 


a 

X 

z 

o 

> 


9 

m 

*0 

O 


o 

M 


W 

<o 

0 » 


P o 

§1 

s § 


n«E 

m 

9t30000 

aio 

-1 .23*51 1-03 

620 

■ 6.996611-09 

630 

■ 6,680829-09 




ml 

3.556527-03 

62 

■ 9,172991-09 

63 

• 1.222779-09 




GMID 

9.99981 

GH2D 

■ 3.833036-09 

GH3D 

- 3.95)655-09 




GMJ 

93.0119 

GM2 

• ,179599 

GM3 

• ,129527 




ThET 

. 62 B| 72 

OTl A 

- 5.599i7|-09 

OTIB 

■ 9.708252-09 




0 T 2 A 

-2*<I50952-03 

DT2B 

P I,222’22-02 

ETIA 

• -2,99|)62-09 




ET IB 

3.956706-05 

ET2A 

■ -9.290913-03 

Et2B 

■ 2,997859-03 




PZO 

.999969 

pao 

• 1,258796-03 

pbo 

• -5.335321-03 




PCO 

-6.093095-03 

Ul* 

■ 2.258592-05 

UlY 

- 5,887238-05- 




UlZ 

0.000000 

U2X 

■ -1.731031-09 

U2Y 

■ 8.990289-09 




U2Z 

0.000000 

UIXO 

• 1.809007-09 

UIYD 

• 1,693599-09 




U2XD 

2.727165-03 

U2T0 

■ -1.9055*1-03 

6H2C 

■ ,179533 




GH3C 

.179533 

GH2CD 

■ 0,000000 

Gh3CD 

■ 0,000000 




ANGH 

200.000 




' 

TIME 

m 

9INOOOO 

WIO 

-5. 872502-09 

«20 

- 1.192796-03 

630 

- 9,019029-09 





3.9A1807-03 

62 

■ 1 , 002589-03 

63 

■ 1,778381-09 




gmio 

9.99971 

GM2D 

■ 2 , 932955-09 

GH30 

• 3,525509-09 




GMI 

99,0119 

GM2 

- .129635 

Gh3 

■ ,|79569 




TMET 

.622909 

OTl A 

■ 5 . 533997-09 

DT IB 

- 9.892285-09 




0T2A 

3.029<(98-03 

Dt2B 

■ 5,591556-63 

Etia 

" -2,872588-09 



» 

ETIB 

9.593382-09 

ET2A 

• -7,099|3l-03 

Et2B 

■ 1,1*2203-02 




PZO 

, 9999*9 

Pao 

■ l,939i7l-o3 

PBO 

• -5,288982-03 




PCO 

-6.039936-03 

Ul X 

• 3.889999-05 

UlY 

■ 5,9|622B-05 




utz 

0.000000 

U2X 

■ 2,179952-09 

U2Y 

■ 3,913827-09 




U2Z 

0.000000 

uixo 

• 2,0807»|-09 

UlYO 

• -3,536Bo3-09 




U2X0 

9.5o9326-03 

U2T0 

■ -7.390628-03 

GH2C 

■ ,129633 




GM3C 

.179533 

GH2C0 

■ 0,000000 

Gh3cO 

* 0,000000 




ANGN 

200.000 





TIME 

m 

ViSOOOO 

NIO 

B. 668789-05 

620 

■ 1,815989-03 

630 

• 9.299192-02 




Wl 

3.939|50-03 

62 

- 1,1601*9-03 

63 

■ 1,977729-09 




GMIO 

9.99973 

6M2D 

- -2,058826-05 

6H30 

■ l,2||7B0*09 




GM| 

95.0119 

GM2 

- .179650 

«M3 

p ,179589 




THET 

.627575 

OTl A 

- 2, 189998-06 

OTIB 

p -9,258132-09 




0T2A 

S.5|5822~o3 

0T2B 

• -5,957229-03 

CTI A 

• 1,589932-q5 




ETlB 

6.865656-09 

ET2A 

■ -9,239752-03 

ET2B 

p 1,108587-02 




PZO 

.999969 

PAO 

■ 1,606*51-03 

PBO 

■ -5,235608*03 




PCO 

-6.023887-03 

UlX 

• 2,693|62-05 

«1T 

p -|.7296|8-05 




UlZ 

0 <000000 

U2X 

• 6,01*1968-09 

U2Y 

■ -3,859269-09 




U2Z 

0*000000 

UIXO 

■ -5.235856-09 

U| YO 

p -8,529636-09 




U2X0 

2.699963-03 

U2V0 

■ -7.096*92-03 

5H2C 

p .179533 




GM3C 

,179533 

CN2C0 

• 0.000000 

6M3C0 

p 0,000000 




ANGH 

200.000 






Fig. 9. Simulation printout lor teat vahicio with spinning rotor 
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Equation (29) may now be simplified by the assumptions (for A: £ u*«0, 

« * as 0, « 0, « 0, as 0, c* as 0, c* » 0, to obtain 


(*£«) 


+ 2 D'^'C’^F 

re® 




- 2 D^'C’^'Zlo^Y - 2 

re® re® 


- u'‘h'‘ - Vu^ri^M'^q'^ - 2^yM'‘q'‘ 

+ 011.5* y C'"u'u'D''‘ 

re®-® 


+ 0IL 2 ^*"C*"w'«'D"*-w*<J»**w* 

re®-® 


- 2 0IL,D*'C*"c'w'- 01L*c* 2 C'"D''‘u' (64) 

re® re® 


The appendage equation (Eq. 16) may be simplified as well (letting /?* = 0) to 
obtain 


= - A/*(2ot/ - r*2c/o)"* - W*2yo 2 C*^J.'Z?^* 


re® 


-M*2yoC‘"^ +A‘ + M*2 ^,o 2 


r A/' 


r^9-k 


011 


-A/*2i/o 2 C*^«'«'D^* 

re® - ® 


(65) 


This appendage equation is analogous to that in Eq. (207) of Ref. 2, whose 
homogeneous solution has the form 

= 2 

y-i 

where Xj and <p-{ are, respectively, eigenvalues and eigenvectors available from 

(M'A/ + K')^^ = 0 


and 


A/'=M*(c/-2^,o2^;o^) 
K’ = K'^ 


so 
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If is the 6n^ by 6n^ matrix 


<t>k =[<>1 -I'M 


the transformatiba 


q“ = <>*’?* (66) 

may be xised to transform Eq. (65) into 

e + alr,“ = <t>^L’, (67) 

where 

Li = -M*(2ou - - M*2j,o S 

re® 

-M*2c;oC«>4- S 

re®-* 

-3/*2yo 2 

/•e® -ff 

If the modal coordinates tj *, tj* , . . . , are now truncated to the set 

Vv • - ' > iJ/v, symbolized by the overbar) and modal damping is also in- 

corporated, Eq. (67) becomes 

^* + = ^/L; (68) 

Returning to the vehicle substructure equation, Eq. (64), the truncated modal 
transformation, may be substituted and the result combined with Eqs. 

(2), (3), (5), and (6) to give 

2 A°^Yj+ 2 2 C°*£* (69a) 

ye® *e® *e® 

(i G^) A + 2 ^ ‘^y. + 2 /I *17* = 2 «,*C'*£* + T, (69b) 

ye® *e® *e® 


where 


r4®’» 2 2 3 by 3 

*e« re® 

^"■'=2 'E 3byl 

*e® re® 

^ok ^ QOkhk^ ^ 3 by 

V ,e® / 

>l'^»g'’'2 2 C'*«, *<!»*'* O'", lby3 

*e® re® 

^'^ -^'"2 2 C%«yr^'*CV. I by l 

■ *e® re® 
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1 by yv* 


' re'A > 

£* = r* _ T* - 5* f (w* + «^^) + 2 D'^'C'i'F' 

/•£* 


+ 


f* 



<DIL 



+ 01L 2 ^*"C 

re‘A 


- w *$**«* - 2 <D*"* 2 C%,ujgjyj 
/■e® ye® 

+ 01L*c* 2 C"Zi'u>'D'\ 3byl 

re « - ® 

^ ^ Z'^C'^'D''^ + 9IL, c", 3 by 3 


A* — </>/" ^*2uo)> ^ 

P* = 3 by iV* 


(^ does not include the effects of appendage deformation.) 

As in Eqs. (32) and (33), substitutions have been made for /i* and /i* based on 
restriction to three orthogonal axisymmetric rotors in with spin axes aligned to 
the unit vectors {b*}, and the relations in Eqs. (43)-(45). Again, it is to be 
understood that any rotor’s moments of inertia are to be included in J*. the 
undeformed substructure’s inertia dyadic for o^, and its mass is included in the 
substructure mass, . 

Operating on the appendage equation, Eq. (68), in a similar way provides 


(A:ef) 2 ^*^Vy+ 2 2* (70) 

ye® re® 

where 

^ *0 = 5*C'^ - P’’ 2 Af* by 3 

re® 

A *> = (a*C% - P*'’ 2 C‘'D'-’‘C%]gj, by 1 

' re® ' 


Ark^_ pk^C'^r -^ , (/■ # k)\ A* by A, 
A'’^=: U, (r = /c); A* by A* 
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- 2 (a*C% - 2 C*'D^*C%]ayg^-i-. 

ye 

-P*' 2 A^*byl 

/■e® - 5 


where modal damping, has been added (see discussion in Section IIIA). 

The substructure and appendage equations may now be combined into a single 
matrix equation of the form Ax = B, 



2 c“*£* 

*e® 


g‘^ 2 + 


ke9 


Q“ 


(71) 


Again the elements of A are, in general, time-variable because of substructure 
relative motion. A is also symmetric. 

Very often, one can justify making the assumption that all the variables, i.e., w°, 
Yy, i)*, and their derivatives are in some sense “small” and a complete linearization 
of Eq. (71) may be carried out. The computational benefits of a total linearization 
are quite substantial since the coefficient matrix. A, then becomes formally con- 
stant, allowing its inverse to be computed only once, in advance of numerical 
integration. 

If each symbol in Eq. (71) is expanded into three parts, the first being free of the 
variables yj, rj*, and their derivatives (indicated by overbar), the second being 
linear in these variables (indicated by overcaret), and the third containing terms 
above the first degree in the variables (indicated by three dots), and if one then 
determines explicit expressions for the new barred and careted symbols from their 
definitions, the linearized form of Eq. (71) becomes 

A°°u°+ 2 '2 [c°*(£*-h£*)-)-C°*£*] (72a) 


(/ E <dP) 

A‘%°+ 2 A‘jy/+ 2 



ye® 

*e® 



2 e,,[C'*(£* + £*) 

+ C'*£*] + f. + f, 

(72b) 


te® 



(A: G 


+ 2 ^"*7?'’= 0* + 0* 

(72c) 


ye ® 

re's 
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i 


where 


C'O = C® + C'° + 

T, = ?, + ?,+ ••• 

= j^ + ^*y + 
£*=■£*+£*+• 
etc., 


and 


' ‘Vi 


CO ^ O' - [/ = 3 by 3 identity matrix 


c'^=-yrir, (r>J) 




Specifically, 


5ig| 


- 2 2 5*" 

*e« re® 


jq/= 2 2 ^*v 

*e® re?’ 




re® 


»— s 

^ V ^ 


sii 


■4”-8"X 2 ««**' 

*e® re® 
ke® re® 

' re® y 


£*=£*-?*+ 2 D^'F' 


re® 


£* = r* _ ?* _ w*f + 2 D'‘'c'"F' + 2 + 

re® re® 






^*o = A*-P*’’ 2 

re® 
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(r^k) 


U, (r = k) 


Q'^ ^ - am^ - P 


C'^^F-frF . T 


91L 




It would remain then to determine T*, T*, F*. F*. f, F, A*, X*, t,, f„ etc., for the 
particular system under study and to carry out the computations in Eq. (72). 
However, in constructing a subroutine to perform these computations, it was found 
to be more efficient to directly manipulate the combined form 


"2. A°jyj+ 2 ^r?*= 2 (73a) 

*e? *e* 

\ie<9) J'V+ 2 2 = S €,*^'*^* + *, (73b) 

ke9 kS'if 


where 


(kE<F) ^ % + 2 


£*=£*+ £* 


C'* = C'* + C'* 


T,. = f, + T, 


etc. 


'J By avoiding the separation into the parts £*, £*, etc., the computation becomes 

? more efficient even though some second-order terms in the linearized variables are 

retained. 

} B. Subroutines MBDYFN, MBOYFL 

A 

5 The Fortran V subroutines MBDYFN and MBDYFL were written to provide 

^ the solutions to Eqs. (71) and (73), respectively. As in the case of MBDYFR, these 

I routines are also exercised by either of two call statements, the first of which 

5 initializes the program with the system constants. 
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Initializing Call Statements 



CALL MBDYFN(NC, H, MB, MS, PB, PS, G, PI, 
NF, F, EIG, REC, RF, WF, ZF) 

or 


CALL MBDYFL(NC, H, MB, MS, PB, PS, G, PI, 

NF, F, EIG, REC, RF, WF, ZF) 

All the arguments in these call statements are defined exactly as given in IIIB, 
with the exception of the two new arguments, EIG and REC. Notice that the 
MBDYFR inputs ER, El, SR, and MF no longer are used in these routines. The 
input arrays RF and EIG are used by the subroutine only if there are nonzero 
external forces and torques A * applied to an appendage. 

EIG(/i, i,j) = array of elements of n = 1, 2, . . . , / = 1, 2 6/2*; 

k = F(rt, I); y = 1, 2, . . . , N^. (Note! This array is not used by 
the routine if A*, for all A £ '?, is zero.) 

REC(/i, j,y) = array containing the “rigid-elastic coupling coefficients," A* and 

F rt = 1, 2, . . . , / = 1, 2 6; k = F{n, 1); j = 

1, 2, ... , N^. (For / = 1, 2, 3, the elements of REC are those of 
jP*; for i = 4, 5, 6, the elements are those of A*’.) 

In order to compute the angular accelerations «®, 7i Y„, and the modal 

coordinate acceleration vectors (A £ ^) at every numerical integration step, the 
simulation must repeatedly enter the subroutine using the dynamic call statement. 


Dynamic Call Statement 

CALL MRATE(NC, TH, TB, TS, FB, FS, TF, FF, GM, 

GMD, GMDD, ET, ETD, WO, WDOT, ETDD, HM) 

where 


ET(n, 0 = array of appendage modal coordinates, ij*; /? = 1 n^ 

k == F(/i, 1), / = 1, . . . , N*. 

ETD(n, /)= array of modal coordinate rates, n = 1 

k = F(«. 1). )■ = 1, . . . , A*. 

ETDD(/i, /) “Solution array for modal coordinate accelerations, rj*; 

« = 1, . . . , A = F(n, 1), / = 1 N^. 


and all other arguments are defined exactly as in IIIB. 

Again, it should be noted that MBDYFN and MBDYFL do not incorporate the 
terms in £* that describe rotor torques on The user must include these terms, if 
rotors are present, in T* (or T*) as it is formed in the main program. 
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Also, if any of the y, are to be prescribed, appropriate values of y„ as well as y, 
and Yi, must be supplied to the subroutine by way of the MRATE dummy 
arguments GMDD, GM, and GMD, respectively. 

When either the MBDYPN or the MBDYFL subroutine is used, the main 
calling program must contain Fortran “type” and storage allocation statements. 
The mandatory statements are: 

Required Specification Statements 

INTEGER NC, NF, H(n„ 2), F(n^, 3), PI(n + 1) 

REAL MB(7), MS(«„ 7), PB(/i„ 3), PS(n^, n„ 3), 

Gin, 3), TH(n), TB(3), TS(n„ 3), FB(3), FS(n„ 3), 

GM(/i), GMD(«), GMDD(n), EIG(n^ 6«*, N*), REQn^ 6, N^), 

RF(np 3), WF(/iy, N^), ZF(n^ N^}, 

TF(n^ /!*, 3), FF(n^ /i*. 3), ET(/i^ N*), 

ETD(rt^ N*), WO(3) 

DOUBLE PRECISION WDOT(/i + 3), ETDD(/V, N^) 

In order that storage allocation for arrays internal to MBDYFN and MBDYFL 
be minimized, the following statement must appear in the subroutine: 

PARAMETER QH = n, QC = n„ QF = n^, NK = /»*, NKT = 

The proper placement of this statement in MBDYFN and MBDYFL is shown in 
their listing (Appendices D and E). 

C. Sample Problems 

To illustrate the use of subroutines MBDYFN and MBDYFL, a sample problem 
suitable for computer simulation will be described. The test vehicle to be simulated 
has the configuration shown in Fig. 10 — a rigid central body, a rigid platform, 
d ,, which is hinged to (2 degrees of freedom), and a flexible appendage, a^, also 
attached to d^. 
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For this example, the numbers used to describe the test vehicle’s mass properties, 
including the appendage, were taken from an actual spacecraft design. The ap- 
pendage model includes the characteristic vibration modes of four solar panels, a 
parabolic antenna, and several other structural members. 

Test Vehicle Constants 

The following numerical constants are required for initializing the subroutines: 

%,= 79.0 kg 
9IL, = 1.93 kg 



Let the modal model for appendage «o (^i) truncated to seven modes, i.e., 
Nq = 1. Thus, 


.0338 1 

.0106 

1 .0023 

1 .0032 

1 -.6055 

1 -.3050 

1 -.0276 

.0017 \ 

.0011 

1 -.0182 
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5o = 2ir[.5756 .6134 .6134 .6307 2.723 2.963 3.047]^ rad/s 

io = (.20 .20 .20 .20 .05 .05 .01]’’ 
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Also, let 


^‘•=[0. 0. 1.]^ 

. ^=[ 1 - ... 

/'=[0. 0. 0.]^, />'° = [0. 0. o.f 

Since no external forces or torques will be applied to the appendage, the eigenvec- 
tor matrix is not needed, nor is the matrix Tq. Finally, 

=1, «/ = 1, «o = 1’ = 7 

A, = 0, d^ — 2, n = 2 

The integer /Iq* which indicates the number of sub-bodies in the appendage model 
and is only required if external forces and torques are applied to appendage «q, has 
been set to the smallest acceptable value that satisfies dimensioning requirements. 


The initializing call statement arguments therefore become 
NC= 1 
H = [0 2] 

MB = [1230. 1290. 1650. -16.29 

MS = [4.75 5.53 1.32 0. 0. 0. 

PB = 0 


-43.45 61.75 79.0] 

1.93] 


PS = 0 


0 . 

1 . 


0 . 

0 . 


1. 

0 . 


P1 = [0 
NF= 1 
F = [0 
EIG = 0 


1 ] 

7] 


(assuming no prescribed hinge motions) 
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WF = 2i7[.5756 .6134 .6134 .6307 2.723 2.963 3.047]^ 

ZF = [.20 .20 .20 .20 .05 .05 .01] 

Test Vehicle Dynamics 

As before, the platform hinge connections will be defined as being of the linear 
spring and viscous damper type, but the position commands will be deleted, so that 

T, = -A'iY, - 
“^1 ~ “ ^272 


where 

/T, = 900. n-m/rad 
/Cj “ 850. n- m/rad 
= 100. n-m-s/rad 
Bj = 100- n*ni*s/rad 

The vehicle response to be simulated in this example will be that due to an 
arbitrary sequence of force and torque pulses applied to the reference body. 4^. A 
rectangular pulse of thrust will be applied in the b° direction with magnitude 300 n 
and a duration of 2 s, starting at / = .5 s. This will be followed by a 1-s torque pulse 
in the b° direction of magnitude 10. n-m, starting at / = 3.5 s. And the last 
disturbance will be a 1-s torque pulse in the b° direction of magnitude 10. n-m, 
starting at / = 6.5 s. The computer program for this dynamic simulation is given in 
Fig. 11. 

Initially, the system is assumed to be completely at rest. Again, the CSSL 111 
language function, “STEP,” is used to construct the applied pulses. Only the 
angular rates of calculated in this example; its inertial angular position is 

not computed. Appendage modal coordinate rates and positions are both provided, 
although only the rates are plotted in the system responses of Fig. 12. A sample of 
the printed output is shown in Fig. 13. 

Notice that by far the greatest disturbing effect to both platform and flexible 
appendage is due to the applied force. However, the changes in u° magnitude due 
to the torque disturbances are quite significant. It is not clear to what extent the 
platform vibrations are coupling with appendage vibrations and reference body 
motion, although the platform rotations are small in magnitude. 

It is apparent that the applied force (fixed with respect to ^g) caused some slight 
accumulation of system angular momentum as the system mass center moved in 
response to platform and appendage vibrations. This small amount (.17 n-m-s) was 
dwarfed, however, by the next pulse of torque, so that after 4.5 s, the angular 
momentum should have been approximately 10 n-m-s. The last torque pulse, 
applied orthogonally to the preceding one, would then raise the total angular 

momentum magnitude to slightly more than + “ \^.\^ n-m-Si The 

simulation printout shows a computed value of 14.25 n-m-s. 
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- _CSSU m JCT_ PRPPVtSJoN_l.*aQ'<ATo«» OtOiJt^^OOiH 02i77b»02ti3t 
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ARRaT TB(}).TS(l,3)tPB(J),FSU,2),6H(2».fiMO(2),<iR00(2) 

ARRAT TH(2I inOUI iTP( I .1 i3> tFFU it »3> iET< I lETDU i7> 
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Fig. 11. SlmulaOofi program (or tmt vohicia dynamics using MBOYFN 
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Fig. 11 (contd) 
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Exactly the same simulation can be made using the linearized subroutine version, 
MBDYFL. The only change necessary in the simulation program of Fig. 1 1 to 
allow the use of the linearized version is the change of “CALL 
MBDYFN(NC, . . . )” to “CALL MBDYFL(NC, . . . )” in the initialization sec- 
tion. This was done ands resulted in solutions for the system response which are 
virtually indistinguishable from those plotted in Fig. 12. However, some slight 
deviations are detectable in the printed output shown in Fig. 14 when compared 
with the MBDYFN results of Fig. 13. The major difference between the two 
simulations in this case is reflected in the computer running time. A total of 2 min 
of accoimtable central processor time (Univac 1 108) was required by the program 
using MBDFN as contrasted with only 1 min of central processor time used by the 
MBDYFL program. In addition, memory storage is considerably reduced by the 
use of MBDYFL, so that the overall cost of producing the desired solutions in this 
case is significantly reduced. 

Another convenient method of reducing computation time and therefore cost 
under certain circumstances is to use these subroutines’ prescribed variable option. 

By setting PI(/) = 1, the hinge angle variables y,, y„ and y, may be prescribed, i.e., 
defined by the user in the main program rather than computed within the 
subroutine. When this is done, any expression in the main program defining the 
hinge torque t,(TH(/)) is ignored by the subroutine. The equations normally solved 
by the subroutine to obtain y, are then deleted from consideration, thus reducing 
the system order and speeding up calculations. 

For an example of this approach, we can return to the program of Fig. 1 1, using 
MBDYFN, and change PI so that PI(1) = 1 and PI(2) = 1 (leaving PI(3) = 1 
unchanged so that the angular momentum calculation is still performed), as shown 
in Fig. 15. This means that the platform hinge rotations are to be prescribed. 
However, by not defining any function for GMDD(l) and GMDD(2), these 
variables remain zero, as will their integrals. Thus, the simulation will proceed as 
before but with y, = y, = y, = 0 (/ = 1, 2); i.e., the platform will be “frozen” or 
rigidly connected to 

The system response (with identical disturbances) in this configuration was 
simulated, and the plotted results were indistinguishable from those in Fig. 13. A 
sample of the simulation’s printed output, shown in Fig. 16, indicates clearly that 
“freezing” the platform has had no significant effect on the dynamic response of 
the reference body or the appendage modal coordinates. However, some numerical 
differences are discernible in the printout. 

Thus, prescribing the platform’s “motion” in this case did not appreciably 
change the overall result and, as a matter of fact, took 15 s less computation time 
than the original run with no prescribed variables, a saving of ^ . 

V. Summary and Conclusions N76 12095 

In this report, detailed mathematical models have been developed, suitable for 
describing the attitude dynamics of vehicles that may be idealized as systems of 
interconnected rigid bodies with possible terminal flexible appendages. The result- 
ing mathematical formulations apply to two kinds of system behavior: (1) generally 
arbitrary rigid-body rotations with the restriction that appendage base body devia- 
tions from some nominal constant spin rate are small, and (2) unrestrained 
rigid-body rotations with the restriction that appendage base motion deviations 
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from a nominally zero angular rate are small. 'The second approach was then 
further restricted to the often very useful assumption that all system rotations are 
small, pennitting a fprmal linearization with respect to hinge and reference body 
rotations. Of course, appendage deformations are assumed small in every case. 

Three FORTRAN subroutines were then described which solve the equations of 
motion for these three cases, namely. MBDYFR (for spinning appendages), 
MBDYFN (for nonspinning appendages), and MBDYFL (linearized for small 
rotations). Each of the routines has much the same functional appearance as those 
programs described in Ref. 6., i.e., an initializing entry and a dynamic entry point, 
with the only differences being the addition of appendage-related parameters, 
variables, and forcing functions. The routines also retain the option of user- 
prescribed rotations at selected hinge connections. However, an additional option 
provided in these programs is that of calculating angular momentum magnitude, 
which at times provides a valuable check on computational accuracy. 

In applying MBDYFR, one can conclude that the mathematical difficulties 
introduced by spin have forced not only a first-order transformation to obtain 
uncoupled coordinates but, as a consequence, two coordinates per mode must be 
solved for in the subroutine. However, what appears to be a computational 
disadvantage in this case may well be softened by the necessity to consider fewer 
modes. Some other difficulties are also introduced by this particular modal trans- 
formation. The presence of both the modal coordinate position and rate in the 
expressions for appendage deformation and deformation rate can lead to signifi- 
cant error if modal damping is inserted (thus disturbing eigenvector orthogonality) 
and large steady-state appendage deformations are present. The user must ensure 
that any appendage deformations in the damped case remain essentially oscillatory 
about a nominally zero mean. MBDYFR, as it now stands, also forces the user, 
regardless of which appendages are spinning or not spinning, to formulate each 
appendage’s modal description using only the first-order transformation, i.e., as if it 
were subject to spin. While it was much more convenient to program MBDYFR in 
this way, future requirements for improved computational efficiency may make a 
modification of MBDYFR desirable. Still, in spite of these particular characteris- 
tics, it is felt that MBDYFR can be successfully employed in a wide variety of 
applications because of its inherent generality and versatility. In addition to the 
prescribed variable and angular momentum calculation options, the user may also 
choose to use MBDYFR to directly calculate the steady-state deformations due to 
centrifugal forces. This is accomplished by setting SR, the nominal appendage 
spin rate, to zero even though, in the simulation, the appendage is spinning. Setting 
SR to zero restores the centrifugal force terms to the equations, and appropriate 
deformations will appear in the solution. However, as indicated before, the greater 
the modal damping under these circumstances, the larger the numerical error will 
be in the steady-state deformations due to spin. 

The routines MBDYFN and MBDYFL are of more immediate utility at JPL 
since current spacecraft designs here are three-axis-stabilized. They represent a 
generalization of the hybrid-mode concept, developed in Ref. 2, to the rigid-body- 
tree approach. As a result, it is no longer necessary to add special terms and 
re-derive equations of motion in order to accommodate discrete rigid-body rota- 
tions (or translations) in the system (as was done, for example, in Ref. 9 for the 
Viking Orbiter with flexible, appendages and rigid propellant slosh masses). Even 
translational dampers can be reasonably well approximated within the hinge- 
connected tree system. Because of its speed advantages and because it usually 
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provides acceptable solution accuracy even when rotations are not strictly small, 
the completely linearized version, MBDYFL, will offer the greatest utility among 
the three programs at JPL for routine control design studies. 

To make these subroutines more easily available to the aerospace industry, they 
have been submitted to COSMIC (Computer Software Management and Informa- 
tion Center), University of Georgia, Athens, Georgia, for evaluation and dis- 
semination to interested agencies and institutions. 
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Appendix A 



Effects of Damping on Rotating Appendage 

Equations 



In Section IIIA, it was pointed out that the addition of viscous damping-like 
terms to the already transformed appendage equations, particularly for the case of 
a nominally rotating appendage/base, is mathematically not justified. However, the 
insertion of modal damping terms is usually thought to be justified on the practical 
basis that it reasonably and more conveniently represents the physical response of 
systems as determined from actual test data. 

However, it may be usefiil to illustrate how and to what extent the mathematical 
inconsistencies so introduced may affect computational results. For example, one 
can show that the insertion of modal damping into Eq. (26) introduces errors in the 
steady-state values of 5*, ij*, and therefore the deformations and q'‘. This can be 
seen from the following. Repeating Eqs. (26) and (27), we have 


5*= - 5*7)* -5*r[L;- 1*5*5* 

(A-1) 

- g*^/L; - 1*5*7)* 

(A-2) 

^* = 2(^,5"* -r*7i*) 

(A-3) 

4* = -2(f,5*5‘* ^■,5*7j*) 

(A-4) 

^*=-2(r*5*l* + v:*5*^*) 

(A-5) 



If we now examine q’‘ and q‘‘ when 5* and have reached a steady-state 
condition, i.e., when 5* = ^* = 0, we have, from (A-1), 

= - a*rjL; - 1*5*5* 

and from (A-2), 

5*5* = o*^i/L; -I- 1*5*7]* 

Substituting from (A-2) into (A-1), 

ii* - -Tin - + s'-'j's'ij*] 

or 

7i*=-r[L;-|*;?;/L;-|*|*7i* 
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or 




+ (A-6) 

Substituting from (A* I) into (A-2), 

or 

or 

+ (A-7) 

From (A-3), (A-6), and (A-7), 

q!^ = 2,j;(f/ l*rr)i; - 2r*(t/ Vey\-fl - 

= 2[ uc ■(-K’- - |*fn + f * + IS?/) ] (a-8) 

where 

= + $*!*) 

From (A-4), (A-6), and (A-7), 

ql^ - 2[.^:*a*t/,-'(r[ + |*^/) - |*rr)]L;^ (A-9) 

Notice that from (A-9), q* 0 in general! However, as becomes infinitesi- 
mally small, (A-8) and (A-9) approach 

and 

4« = 2[^*5*r[-r*a*^/]z,;=0 

due to orthogonality relations between and F^. 

The discovery above that, in general.^* 7^0 when modal damping is introduced 
is rather disconcerting. It is further disturbing to realize that if the appendage 
deformation rates are not zero when the modal coordinates appear to indicate 
an appendage at rest, then the angular momentum calculations of the subroutines, 
based on 9 *, will be in error as well. 
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Fortunately, we have assumed that the appendage deformations, 9 *, and their 
derivatives are small and represent only the oscillatory component of the total 
possible deformation. This tends to imply that L’^ must be very small to begin with 
and that the steady-state levels of (or its derivatives) after damping are “small” 
compared to its transient oscillatory amplitudes. Therefore the errors introduced in 
(A- 8 ) and (A-9) should be of relatively little significance. However, one should be 
aware of their existence and that they can add to other computational errors. 
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Appendix B 

Systenr Angular Momentum Computation 

In Ref. 5, Hooker shows that for a dynamical system of the type considered 
here, namely, a topological tree of rigid bodies any one of which may carry a 
flexible appendage, the equations are of the general form 

Ax=^ B 

where 


^00 ' ^O/t ' ^0 

r — r - 

I a I Z> 

— -f - - r - 

\ \ c 

and Hooker proves that the angular momentum of this system about its mass 
center is the product of the first row of ^ with x: 

H = aggW® + Go* Y M (B* 0 

and that the 3 by 3 matrix Ogg represents the instantaneous system inertia. The 
relation (B-1) is precisely that implemented in each of the subroutines MBDYFR, 
MBDYFN, and MBDYFL to calculate H (3 by 1). ff is a 3 by 1 vector matrix 
whose elements are the components of the system angular momentum vector in the 
reference body frame. These three elements are available within the subroutine if the 
user wishes to extract them. He may also wish to transform them to an inertial 
reference frame in certain situations as a check on his simulation accuracy. 
However, the normal subroutine function as shown here in the examples and 
listings is to supply the user with only the magnitude of H, i.e., 

\H\ = {h^t + hl + hl)' 

where 

H = [h,h,h,f 
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Appendix C 


Subroutine MBDYFR Listing and User 
Requirements 

Subroutine Entry Statements 

CALL MBDYFR(NC, H, MB, MS. PB, PS, G, PI, NF, F, 

ER, El, SR, MF, RF, WF, ZF) 

CALL MRATE(NC, TH, TB, TS, FB, FS, TF, FF, GM, GMD, 
GMDD, DT, ET, WO, WDOT, DTD, ETD, HM) 


Input / Output Variable Type and Storage Specifications 

INTEGER NC, NF, H(/i„ 2), F(ry, 3), PI(« + 1) 

REAL MB(7), MS(/.„ 7), PB(/i,, 3), PS(/i„ 3), G(n, 3), 

TH(/i), TB(3), TS(/i„ 3), FB(3), FS{/.„ 3), GM(«), 

GMD(n), GMDD(/i), ER(/i^, 6«t, N,^), EI(n^, 6n^^, 

MF(/y, n^, 7), RF(/i^, n*, 3), WF(/i^, N^), ZF(n^, A*), 

TF(n/, n*, 3), FF(/y, n^, 3), DT(/i/, A*), ET(n^, A*), 

WO(3), SR(/i/, 3) 

DOUBLE PRECISION WDOT(/i + 3), DTD(n^, A*), 

ETD(«/, A*) 

External Subroutines Called 

CHOLD — double precision subroutine for solving matrix equations of the form 

Ax = B 

where /I is a square, symmetric, positive-definite matrix (see state- 
ment 1291). 

Subroutine Setup 
Insert the Fortran statement 

PARAMETER QC = n„ QH = n, QF = n^, NK = n^, NKT = 


(If more than one appendage is present, use the largest n^ and A^ for the 
PARAMETER statement to provide sufficient storage.) 
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Data Restrictions 


n > I, n^ > I, n^ > 1, n* > 1, > 1 

Core Storage Required 
Code: 6500 words 

Data: —500 words (minimum; increases with n, etc.) 
Listing 


!• 

2» C 
3» C 
H* C 

5 » 

6 * 

;• 

8» 

9* 

10* C 
« 1. C 
12« C 
13* 
l*4« 

>5» 

18* 

17» 

18* 

!»• 

20 * 

21« 

22* 

23 « 

2*»* 

25* 

26 * 

27 * 

28 * 

29 » 

30 * 

31 * 

32* C 
33» C 
3<»» c 
35» 

38 * 

37 * 

38 * 

3?* 

<*0» 87 

H2» 

<)<«• 

<♦5* 

H6» 89 

H7» 86 

H8* 

99 * 

5o» 

51 . 

S2« 


SUBPoUTlNEH807FR(^C,C,H8,fiA,P8,P*,'i|PltNF,F.ERtEl|SR,(i|F,«F»8F,2F> 

adjustable ol'^C'SIONS 
Integer pi i i i iC (nc .2> 

peal HR( l 1 ,HA«NC,7» ,I*BINC,3) ,PA{MC,NC,J> 

PaRAmETEP qc*2i0m-3,QF»2.NK»i ,N<T»2 

PAPAhETEP NAK"**NK tS«UC*l .V-QH^S.VN^HaV • S 3a J*S . Qa«H f NHaRH 
PaPahETeP ST*'^*2aQF«NICT (SPaHaST 

AOOITIONAL oI'^ENStONEO VARIABLES 

double precision A(ST.ST),B^1ASS(S> 

iNTeCEP E'*S(9 tS I ,CPS(UC,S4 ,H I 0 I ,H I I S I ,F I ( S ) ,F ( Np , 3 ) 

PEAL AOOI 3, 31 I AB< 3,3» , AOM ( QF , 3 • T » , a OF P I QF , 3 , NK T ) , aKFR ( OF i , Na T 
SI .AKfHQFiOH.NKT) ,aC<3,3»,ASIQ,'JI ,AVC(»,3) ,AISI3) ,B(8F.NK,J1 ,B0IPF, 
SNA ,31 .CE«3| ,CL (31 ,CK (RF , 3 » , CA 0 ( IF , 3 ) , COU t 9 f • 3 » , C8 ( 3 » , C«aO ( S , 3 » , Cy I 
S3l,CW<S,3l*.0X‘S.SI,OY(S,S),OZtS,S» , 0*0 ( S , S I , OT© I S , S I , OfO ( S , S I , OOSO 
*(«F ,3l .OLKPlOF .3,MAT) ,0LKI I dp , 3 ,NA T I ,OLK PO I «F »3,N*T > ,OLA I 0 ( 9F i 3 , NK 
ST I ,0UP(3 ,NkT> fOUI (3,NKT) .OUXO(QF) ,0UY0(9F I , OUZO ( OF ) >E A ( 3 I ,£P ( Np , N6 
SK.NKTI ,CI ‘nP,N6A,naT| .FEXOIS) ,FEY 0(S) , FEZO I S I , PS ( S , 3 ) , 60 I 0 , 3 I , 66 t 0 

S.3> .6(0.3) .r,K(QF,3.NKr > ,6PS0(QF,3 ) . GKOS ( OF . 3 ,NK T I , I I | > I 22 » 1 33 , | I 2 . 

Sll3,|23.|Xx(Sl.tYY(S>>tZZ(Sl.lXY(S)>IXZ(SI,irZIS>iLXtS,S)iLT|S,S), 
»LZ(S.S|.MSb(S) .HS.Hf (NF .NA, 7 ) ,nCK (OF .3 > .NCKOtOF .31 .Fh IS ,3«3) .PSGIS 
S.S. 3 1 .PS( S.s.3 ,31 ,PK(0F,3,NKT) ,PG5O(0F,3 ) , PSF ( S . 5 , 3 • 3 ) . PKOS ( OF , 3 , N 
*Kri,RF(NF,NKt3l.SR(0F»3|,TX0IS),TY0(5l,TZ0(S),T(6,3i3I.TS(Si3l,Ul6 
SF ,NK ,3 I ,U 0 ( gF ,NK ,3 I ,yjl3 ,3 1 , VJO (3 , 3 ) . VJOO (OF .3.3I.VE|0F,3>,VB(QF,N 
S6K I , wF ( NF , M kT I . W iftOE I OF . 3 ) . PS J ( OM . 3 I , Z F ( NF . N* T I . 2 SR ( NF . NA T I . Z S I I OF . 
SNKTl ,P»(3I ,hH(3) 

EOU I valence ( a ,PS J , (LX.OXO) . ILY ,oYO) . iLZ , ozo» 

NB“NC*I 

define EPS<k.JI using c 

00 86 K*1 INC 
00 86 J"2iNB 

IF (K.EO. 1 J.| I ) CPSlK.JIal 

IF(K.LT. ( J-l I ) GO TO 87 

GO TO 86 

CONTINUE 

JQ«K * I 

Jl-J>l 

DO 89 LaJO.jl 
IFIK.GT. (L-1 I I 60 TO 89 

1F| |CPS( K ,Ll lEO* I I .ANOi lClJ-1 .II.EO«(L-nil CPS(K.J) ai 

continue ’ 

CONTINUE 

LaO 

00 I Jal.Nc 
KK-C I J .2 ) 

00 I Kai.KK 
LaL*l 
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S3* 

S"4* 1 

S4* C 
S6* C 
S7. c 
Stt* 

s»* 

60* 

«|* 

62* 

6 3* a 
6H* c 

6S* C 
46* C 
67* 

68* 

69* 

7a* 

72* 

73* 

74* 

7S* 47 

76* C 
77* C 
76* C 
79* C 
80* 

81* 239 

82* 

83* 

84* 2^2 

85* 

86* 

87* C 
88* C 
89* C 
90* 

9 J* 

’8* 2*»8 
»3* C 
94* C 
95* C 
96* 

97* 

98* 46| 

99* 

lOO* c 
to 1 • c 

102* C 
103* C 
104* 
lOS* 

106 * 

107* 

108* 

109* 

1 to* 

111* 

112* 

113* 

1 1 4* 

115* 

116* 

1 1 7* 

118* 

1 19* 

J2a* 35 
l2l« 


00 1 I ■ I ,'’*8 

EPS ( u • 1 > "CPS • J • • 1 

COHPuTE Hlt)-C. MHERE t*H|N«ie label ANU C*c0NNECT10N label 
1*0 

00 8 Jm2,Ng - .. 

KlC*C t J- hi2 » 

00 8 8 fi 1 • K K 

1*1*1 
HI 1 laJ-1 

COHPllTC Hl(ll*Jt taHCnE l*800T LA8EL*1 ANO J*MEAKEST HINSL label 

H I ( 1 1 ■ 1 

H I ( NB 1 *»H 

00 47 ?*NM,1 

IF ( 1 .E>1. 1 I qO to 47 

K I *H I 1 I 

K2*H( 1-1 ) 

lF(Kl«Ea.K7| 60 TO 47 
MI (K2*l 1*1-1 
CONT I NUE 

OEEfNt Fl(j,*<, BHEHE J*B007-LAOEL*1 aND IC IS A PPE NO A •»£ -LAB t L 
(IF K*0. BOOT M«S NO FLEX> APpENOaOEI 


00 239 N*1.m8 
FI (Nl*n 
00 242 K * 1 ,MF 
JN*F|IC, 1 1*1 
F I ( JN I *< 

NF*Np 

N3*N8 

oefine substrocture masses 

H$B( 1 |*MB(7I 
00 248 N*2,NB 
MS8< N l•MA 1 N* 1 • 

T0T*L number of flea. aPPENOaGE mooes to be HETaIMEO 
NTMO*0 

OO 861 K*1,nF 
NTMaaNTM0*F|8i3 > 

NT2*2«NTM0 

Initial calculation of bahyCenter vectors m.r.t. body c.b»s 
ANO HINGE POINTS 


lAX( I i*M3< I : 

lYYi I i»Maii) 

122(1 )*MB< 3) 

I XT ( 1 I *m8 < 4 1 
1X2(1 I*MB(5I 
IY2( 1 I*MB(6I 
BMASS ( • 1 *Mb ( 7 I 
Tm*BmASS ( 1 I 
00 35 J*2iNB 
1 XX ( J I *MA ( J- 1 I 1 ) 

1 Y Y ( j ) *MA ( J- 1 i2 I 
I 2Z( J*«MA ( J. 1 I 3 > 
1XT( jl*MA( j-1 •‘♦1 
I X2 ( J I *HA ( J- 1 f S I 

IYZ(J>*MA( j-l'.A) 

bmassi J • "Ha ( j- 1 1 7 1 

TH*TH*aMASs ( J 1 
00 149 I*l,N*b 




JPL technical report 32-1598 



J22» 


123» 


129# 


125* 


126* 


127« 


128# 


l29# 

70 

I30« 


I3l* 


132» 


I33» 

900 

1 39» 


I35» 


l36» 

600 

137» 


138* 

500 

139# 


190# 


191# 


IR2« 

SO 

1939 


199# 

90 

195# 


196# 

101 

197# 


1 98# 


199# 


ISO# 

163 

ISt# 


1529 


1539 

I 99 

1599 


1559 


1569 


1579 


1589 


1599 


I AO* 


1619 


1629 

13 

1639 

C 

1699 

c 

1659 

c 

1669 


1679 


1689 


169* 


1709 


1719 


1T2* 


1739 


1799 


1759 


1769 

736 

I 779 

C 

1789 

C 

1 79* 

C 

1809 


181* 


1829 


1839 


1899 


1859 


1869 


1879 


1 88* 


189* 


1909 



00 iH^ 

Jl aj.l 

IFd.CO.J) G° TO 1*3 
ird.fiT.J) sO TO 7o 
IF ( I .EQ. 1 I sO TO 80 
If <CFSt 1 1 ,j) .to. 1 ) SO TO ‘♦00 
Lx < I , J) aPA( I 1 > 1 1 • 1 ) 

LTd ,J)«PA(|t.ll.2) 

LZ ( I , J )aPA( I I 1 1 I t3| 

SO TO I‘*9 
CONT tNUE 
00 AqO <■! .Jt 

lF(CPS(KiJ).£a«l| 60 TO SOO 
CONT I NUE 
SO TO IA9 

LX(t , J>>PA (I < •K«n 
LTd .J)aPA(il»K.2i 
LZ < I . J>«PA ( I 1 tKtS) 

SO To MT 
00 9o L«l « J1 

IF(CPS(LiJX.CO>d SO TO 101 
CONT I NUE 
SO To 199 
LX ( I . J laPB (L • I > 

LY (I , J I aPa (t |2> 

LZ f I ,Jl«PB<t.,3> 

SO TO 199 
LXd.JlaO. 

LTd .JlaOt 
LZd ,JlaO< 

CONTINUE 
00 13 Nal.NB 
00 13 U"1*NB 
OX(N,JlaLX(NtU) 
or (N, Jl atrtNiU) 

OZ(N.J|a|,Z(N>>n 

00 I 3 Ral ,H|0 

OX(N, JlaQX (NiO)-(BMASSU)/TM)a|.X(N»A> 

OY «N. J 1 aOT (N lUl'ISMASSlK I /TM ) »LY I N ,K ) 

OZ(N,J |aoZiNfU)-(8NASSU)/TNiaLZ(N|K) 
nominal spin Rate centrifugal forces 

00 736 Kal.NF 
I “F ( K , 1 > *I 
RI«Sr(K,1 1 
RZ"SR (K .Z I 
R3»Sr(K, 31 
0i"0xd ,1 ) 

02»0v( I ,I » 

03«oz< I ,n 

6«0E (K , I ) ".r 3* (HsaOfRl #03 I *R 2 • I -R2 *0 1 *R J *02 » 
RW0E(K,2I*R3*<*R3«029R2*03)-R1*IRi#02-R2*01 1 
WWOC < K . 31 ••r2«1-R3#02*R2*03 ) #R 1 • ( R3 «0 I “R I »03 ) 

calculation of AUSMENTEO inertia oTAOIcS for each BOqY 

00 3 I Nal I nB 
FHI N, I , n»I x*« N» 

RH(N, I ,2)"-lXY(N| 

FhIN.I ,3I-*iXZ(N) 

PH<N,2,2)"lyYiN) 

PHtN,2,3l«-lYZINl 

'’MIN,3,3)«1zZ‘N) 

00 30 J«I iNB 

Pm(N, 1 ,l )»PhCN, 1 ,i )*8MASS( J)*(0 YINiJ»#»2*0z*N,J|## 2> 
PHiNfl 

PH«N,1 ,3)"Ph«N,I ,3I-bNASS(J)#0X(N,JJ#0ZIN,j) 
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I’l 

l»2 

193' 

1 

l’S( 

1’6 

197 

198 

199 

200 
201 
202 
203 
20H 

205 

206 

207 

208 

209 

210 
211 
212 
213 
219 

215 

216 

217 

218 

219 

220 
221 
222 
223 
229 
22b 
226 

227 

228 

229 

230 

231 
222 
233 
239 

235 

236 

237 

238 
239 

290 

291 

292 

293 
299 

295 

296 

297 

298 

299 

250 

251 

252 

253 
259' 
255 
256' 

257 

258 
259' 


PH«N,2.2>“PM«N,2i 21*BH«SS1 jl»10X(N,J)»»2^02lN,J»«*21 

PH(N.2.3)«PH<Nt2,3)-BHASS(j)»Dr(NiJi«0ZlNiJ| 

30 P.H(M,3,3l“PH<N.3,3).*aHASSlJ)*«0X{N,J)*»2*0YlN,J)»*2) 

PH(B.2.1 )«PHlNii ,21 

PH(N,3. 1 (■PhIN, 1,3) 

31 PH(N.3.2)-Ph(9.2.31 
C 

C COHPUTC PK aBO 5k (3 X NKT ARRAYS) 

C 

00 201 X«1 
LN»r (X ,2 ) 
jNTaF(K<3) 

00 201 la|,3 
00 201 J“l,jMT 
PXlK.l ,JI»0. 

6X(X. I ,j)-o. 

00 202 L»1 ,lN 
Ul.a6*(L-l Ut 

PKlIC.I ,J)-Pk(X,I (*(•*• »2|*E»(K,LL,J) 

202 OK (K • 1 I J)«6k(X t l,J)«HF(K«U«2)*ei(KiLL,J) 

PKCK.1 ,J)a2.«PX<K.I ,jl 

SK(K,l ,J»-2.»0K1X.I ,J> 

201 CONYINUE 
C 

C compute OtxR-ANO OLK I-TraNSPOSC HaTRIcES (3 X MKT aRRAYS) 

c 

00 203 KbI.nP 

UN«F(K,21 

3NTaFlK,3> 

00 203 J-l.jNT 
00 209 1-1,3 
OLKRIK.I lUl-O' 

209 OLKI (K, I ,JlaO« 

00 205 Lai ,i.N 
L ia6« (L-1 )♦! 

L2aLl*l 

L3«L2'*1 

L9a(.3ai 

L5<»L9'*1 

L6«L5*1 

OLKRIK ,1 ,j|aOLKR<K ,1 ,jl*MF(K ,L , 7 ) a ( E 1 IK , L 3 , J ) »R F C K ,L , 2 ) 

* •Ct(KiL2>'>l*RF(KiL>3l I-MfCK.L t 1 1 »E1 IK ,U9 , J) 

% -MF<K,L.9)aCI (K.uStjl . HF < K , L 1 5 ) -E I I K , L 6 . J ) 

OLKRIK ,2,J»aOLKR U , 2 , JIaHFIK ,L .7)a I El IK,Ll,j)aRFiK,L,3) 

* -El (KiL3iJl«RF«KtL.l ) I♦NF<K,L.2••E1 IK.LS.J) 

* -MF (K ,L .9 ) •£! <K ,L9,J) - MF ( K , L . 6 1 »E I I K ,L 6 . J ) 

OLKRIK .3«J )a0LKR(K ,3,3)aMF(K ,L (7 ) a(El ) K , L 2 , J ) -Rf j a , L , ) ) 

* -El (K ilI t JI»RF(K.Lt2) )*RF«K,L.3'»EI tK,L*, J) 

» -«F(K.l.,5laEI (K,L9,J) - MF f K ,L » 6 ) -E I I x , L5 , J ) 

OLKl (K . 1 ,J laOLKI (K ,1 ,J 1*MF(K ,L 17) a(ER IK tL3,J ) aRF(K ,L ,2) 

* -ER(K<L2*'J1*RE<K,L,3) )*Hf1K,L,1 >»CRIK,L9,J) 

* -MFIK.L,9)aERU,LbtJ> - MF 1 K ,L 1 5 I -ER ( K , L6 , J ) 

OLK I (K ,2<J laOLKl (K ,2iJ laMf |K ,L t 7 ) a I ER I K , L I , J I -Rp (K ,L ,3 ) 

» -ERIK.1.3 *Jl*RPlKtL.l »)aMFCX,Uf2)aEH(K,i,5,j) 

9 -MF|K,l.,9)aER(K,L9,Jl - MF 1 K , L , 6 ) aCR 1 K , L6 , J I 

OLK I (K.3iJ)a0LKI < K . 3 .J I aMF IK ,L 1 7 | a (ER IK ,L2 ,0 ) aRp ( K ,L , 1 ) 

S -ERlK.t 1 .J)aRF|<,L,2»«a''FlXiL,3laERIK,L6,J) 

« -MP(K.|..5laER(K,L9.J) - MF 1 K , L |6 ) a£R ( K ,L5 t J 1 

205 CONTINUE 

00 20P 1*1,3 

DLKR(K,| ,J|a-2.aOLKR(Ktl iJiaRFlKiJ) 

206 OLKl IK . I I Jta-2>aoLKI IK t I • J)*WF(K , J) 

203 CONTINUE 
return 

Entry mraTe inc iTh ,tb iTa ,fb,Pa ,tf,ff ,gm ,smo ,« noo , 0 T ,Et »no «Root , 
«otd,etd,hm;ui00i 

real Tf IOF ,hK ,3) ,FF I8F .NK ,3» .OTIQp ,N|CT) iET I Qp ,MKT ) , Te < 3 1 , T a 1 NC , 3 ) , 
SFBI3) •PA|Nc,3) ,CH( I I ,GM 0 (| ) .GHOOl) > ,TH( | I , RQ I 3 ) , RXO ( S 1 ,RY0(S) ,H20( 
SS),C(S3.|I 
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■■3 



260* 


DOUBLE PRECISION eC 1 ST I , OT 0 1 QF • NK T I i E TO I QF , NK T ) , 800 T | V ) 

26 I* 

C 



262* 

C. 

BOOT.To-BOqY COORqINATE TKaNSPORhaT ION 

HATRICES 

263* 

c 



26m« 


00 335 J>I.nH 


265* 


HHa J. 1 


266* 


N*H IJ ) * 1 


267* 


S«HaSlN(SM( j| 1 


268* 


C«MacOSIGR|J> I 


269* 


CGMl ■! .»CGH 


27o» 


S|*CSMl*6< J. 1 • 


27l» 


62*CGH| *61 J.2I 


272* 


G3»CgMI* 6( j,3» 


273* 


SG|*SGH*G( J,l 1 


27*». 


SG2aSSN*G( J,2I 


275* 


SG3*S<>N*0(J.3> 


276* 


0|S*G1*GIU, 1 1 


277* 


G2S-g2*G(J.2I 


278* 


G3S*g3*G ( 3 I 


279* 


0 1 2bG t «G ( J , 2 I 


280* 


G 1 3*gI *G( Ji3 * 


28i« 


<a23*G2*G 1 J • 3 1 


282* 


ABI 1 .1 i«CGH«GIS 


283* 


AbI 1 .2)aSG3*012 


2B<«* 


A8» 1 .3 ) •-Ss2*S13 


28s* 


A8 < 2 • 1 1 "-SgS*®! 2 


286* 


AB<2.2>*CGh*G2S 


287* 


48(2.31 aSGi *G23 


288* 


4813,11 *SG2*Gt3 


289* 


4B(3,2)a-SGt*<i23 


290* 


4a<3,3>aCGN*GJS 


2’l* 


ir(J.E4«ll r,0 TO 33G0 


292* 


00 321 L*«N.l 


293* 


lF<CPS(L.Ni .EO.l 1 G(J TO 322 


29*»* 

32t 

CONTINUE 


29s* 


GO TO 3350 


296* 

322 

RaL 


297* 


00 339 Lai. 3 


298* 


Oo 339 Hal , 3 


299* 


T( J.LiHJaO. 


300* 


00 339 |al ,3 


301* 

339 

TlJ,L.H|aT(j,L.N|«AB(L.|>*TlK.I.H) 


302* 


GO To 335 


303* 

33S0 

CONTINUE 


30H* 


00 33SI La| .3 


30S* 


00 3351 Ha, ,3 


306* 

3351 

T(U.L<N>*4biLiH> 


307* 

33S 

CONTINUE 


308* 

C 



309* 

C 

COORO. TRanSPORH|,T|ON of 6 VECTORS (To 

REF. BOOT FRAhE) 

310* 

c 



311* 


00 362 1 a| , nH 


312* 


00 362 ja |,3 


313* 


G0( 1 .J)aO« 


319* 


00 362 Ka |,3 


315* 


G0( 1 .JlafiOl I ,U)*T( 1 .K.JI*G( 1 ,KI 


316* 

362 

CONTINUE 


317* 

C 



318* 

c 

ANG. VELOCITT COhPONENTS OF EACH BOOT 

(IN NEF. boot FKAHE) 

319* 

c 



32q* 


00 366 Kal.NH 


321* 


GG(K, 1 )aGHo|K)*GO(K, 1 i 


322* 


SG(K,2)aGN0lKI*G0(K.2> 


323* 

366 

.GG(K,3»aGNo('(>*<>0|K,3l 


329* 


00 361 jat.na 


32S* 


KyaMI ( Jl 


326* 


8X0( J|awo(| 1 


327* 


WT0(j|aB0l2l 


328* 


8Z0(jla80(3| 
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ii 



329a 



330* 



33la 


Mi 

332a 



333* 



33na 

3A 


335* 

3*1 

33Aa 

C 


337a 

C 


338* 

c 


339a 



390a 



3<*ta 



392a 



393a 



399a 



395a 



39Aa 


mi 

39/a 



39aa 



399a 



353a 

3AA8 


35|a 

3*A2 


352a 



353a 


}• V'.v:’4 

35<ta 



3S5* 

3*A* 


35Aa 

C 


357a 

C 


3Saa 

C 


359a 



3A0a 



36|a 



3A2a 



3«3a 



3A9a 



3«Sa 



3AA* 



3A7a 



3ABa 



3A9a 



37oa 


ms 

37|a 



372a 



373a 



37ta 

9A9 


37Sa 


m 

37Aa 

972 


377a 


A 

37Ba 

9720 


379a 



38oa 



38] a 



382a 


- ' . 

383a 



38<«a 

9721 

38Sa 

9A8 


38Aa 

c 


387a 

C 

ify^ 

388a 

c 


389a 


'-A 

390* 



39|a 


AfS'i 

392a 



393a 



39<*a 



395a 



39Aa 



397a 





00 K>| tKV 

lr(EPS(KiJi.EQtO) 60 TO 3A 
.ftXOIJIaWXOljl^OGlKt I I 
'«Y0(J>attY0(j)*6G(K,2> 

•Z0<j>-wZ0(j)«66(K,3> 

continue 

CONTINUE 

AN6. VELOCITY components AT EACH HINGE (IN REF. BOOT FRahE) 

00 }«AG N"! ,NH 
Hl«M*| 

NCaH(N)*| 

NI-MI (MC) 

«HXOa»XO(HCI 

WHYOaNYO I Hc ) 

NHZ0al*20(Hc) 

lF(NI.CQ»n| GO To 3BG7 
00 3A6S N-HI 'N| 

«HXOaNHXO«GG<N.I ) 

«HYOa«HTO-oo<'<|2) 

NHZ0aNHZ0-GG<N,3| 

CONTINUE 

l«GJ(Hi I >■GG(Ht3l•|)HY0•GG(H,Z)•NHZ0 
«GJ(H.2 I-Gg(Ni I )««HZ a-GGlN,3I A«HX0 
«GJ(Hi3laGolNt2)*NHXO>GG(M,t laMHTO 

continue 

transform Pk aNO GK matrices to reference boot BASIS.NUlTiBT freg. 

00 rag Xat,M^ 

KKaF IK , I )«| 

JNTaFIK«3i 

IFlKKtEQtll GO To <1720 
NaMlIKKI 
00 M72 |al ,3 
00 R72 J»l ,jNT 
OLKROIKil •Jl"0« 

OtKIOIK* I iJiaO* 

PKOSlK.l ,0|aO» 

GKOSIK ,I .J|aO« 

00 HAV L"l ,3 

OLKROIK.I tJiaOLKRoiK.I »JI*TIM,L,I ) aOLXR ( K , . J I 
OLK IO(K I I fJiaOLK IO(K ,I..>I»T(M.L.I> aOLKI (K ,Ui J) 

PKOSlK.l .J|aPKOS(K.| .J>aT(NtLfI*aPKIK,LtJi 
GKOSIK, I .JlaGKoSU.I .JI*T(MtLtll*GK(K.L|J) 

PKOSlK.l .JlaPKOSlK.l .JlaPFlK.JI 
GKOSlK.I .JlaGKOSlK.I .OIaNF|K,U» 

GO TO <IA8 

CONTINUE 

00 1721 la| ,3 

00 R72I J"I.JNT 

DLKROlK.l .JiaOLKRIK.l ,J| 

OLK I OIK. I ijiaOLKI IK. I .0) 

PKOSlK.l . JIaPK IK . I .g|a«FlK. J| 

GKOSlK.I iJiaGKIK.l ,U)a«F(K,J| 

continue- 

compute total E*Te«NAL fO^cC O'* E»CH substructure UN Ref* 0®®!*©*) 

FEXOI 1 laFBl I i 
FEYOl I )aF8|2l 
FEZ0H)aFB|3» 

IFIFl (lltEo.OI Go TO 25R 
IL«F1 I I I 
JNaFi IL.2I 
00 2S3 Jal . jN 

FEXO(l)aFExOll)*FF(lL.J>ll 
PEYOl 1 laFEyOl I (♦PFI IL.J.Zi 
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398* 

253 

PEZO( 1 i-rezoii i*rM IL.J.3) 

399* 

259 

CONTtHUE, 

900* 


rs< J .M*fExon I 

H0»» 


rsl 1 , 2 l«FEf 0 » » I 

902* 


FS( 1 .3)*FEzo( 1 > 

903* 


00 298 Na2.NB 

HOH* 


K*N-| 

90S* 


00 2980 L*l,3 

908* 

2980 

rs<N,LI*rA(K,LI 

907* 


iFiri INI .Eo.Oi Oo TO 298 

908* 


IL*FJ (Ml 

909* 


JN“F( IL.21 

910» 


00 295 Jal.jN 

9l|» 


00 295 tal,3 

9U* 

295 

FSIN. I 1 *FS(n. n*rF( IL.J. li 

9I3« 

298 

CONTINUE 

9l«t« 

C 


915* 

C 

confute tr^nSl. aNq fotat, oiSPlace'^ents Of afpenda(>e sub-bOoJeS 

916* 

c 


917« 


00 232 K*l . nF 

9la« 


JN*F(K,2l 

918* 


LKaF(K,3> 

92o* 


00 233 Jal.jN 

92i» 


00 233 ta| .3 

922* 


UIK. jt I 1*0. 

923* 


BlK.j.I )aO. 

929* 


UO IF ,J , t lag. 

92S» 


SO(K,J.tl*0. 

928« 


tO«( J-1 l*8*I 

927* 


tH«tO*3 

928* 


00 233 L«1,lF 

92»« 


U(K.j,t|aU(Ki3tl )* 2 .*EP<K, |0,L)*DT|K,u)-2>*ei U, 10 >L)*ET|K,U 

930» 


B|KiJ. 1)*B(K#J.J J*2.*C«|F.lB,LI*0T|F.LI-2.*EHlC,l«,L|*ET|F,LJ 

931* 


UO IF ,J,I l«UO <F .J,l l•2.•CI*<F .10 ,L |*ET(K ,L l••F(K ,L» 

932» 


* -2.*EIIF.lD.L)*0TlK.L>*»FI|C,t) 

933* 

233 

SOIK, J. I lagolK.W, ( i•2••eBIK• lBtU>*ETIn,L)*«F(K.LI 

939* 


S .2**CllFttB»L)*0T(K,L)*«F|F,LI 

93S* 

232 

CONTINUE 

938* 

C 


937* 

c 

COMPuTf C.N. perturbation (FROM NON. UNoeFORMEo LOCATIONI ON EACH 

938* 

c 

Substructure »|Th an appenoase ilocal cooro$.) 

938* 

c 


990* 


DO 282 Fa| ,nF 

99J* 


IFar (K , n*l 

992* 


3N"F|F.2I 

993» 


00 283 I ■1,3 

998* 


NcFOlF.I lag. 

99S* 

243 

MCFIK , 1 |aO. 

996* 


00 285 J-l.jN 

99/» 


00 285 la |,3 

99a* 


NcFoiF.I lancKOlF,! ).U0<K.U,l I*HFiF,U|7l 

998* 

24S 

NCFIF. 1 »-NCF«F.n-U(F.U.I I*Nf(K. J.TI 

95o* 


00 284 (■1.3 

9S|* 


CKO IF, I I-NckO(K.I I /MSB (IF I 

952* 

288 

CKIK.I laNCK (F .1 )/HSBUK| 

953* 

242 

CONTINUE 

959* 

C 


955* 

c 

CONFUTE total EXTERNAL TORQUe ON EACH SUBSTRUCTURE R.R.T, |TS 

958* 

c 

Instantaneous c*m* iIn local cooro.i 

957* 

c 


95a* 


oo 28B l*I«3 

958* 

248 

TS« J ,L)»TB(lI 

980* 


00 287 N«2,nB 

981* 


FaNai 

982* 


00 287 L«l,3 

943* 

247 

TSIN.L)-TA(KtL) 

989* 


00 2870 N>| ,NB 

985* 


IL«FI (NI 

948* 


UdL.EQ.Ol 60 To 2470 
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<l*7« 

<468* 

870» 2*74 

87j» 2*70 

<«72« 

‘»73> 

'*7<»» 

878* 

S77« 

<t7«« 2*’ 

879» 

880« 

<»8l* 

H82» 

883* 

888 * 

88S* 

886 * 

887» 

888 * 

889» 222 

890« 27t 

891« C 
892* C 
893* C 
898* 

89S* 

894* 

897« 


898* 


899. 


soo* 


SOI* 


$02* 


503* 


S08* 


SOS* 


SO** 


SOT* 


S08* 


509* 


510* 


Si l* 


512* 


S13* 


518* 


SIS* 


51** 


517* 


SI8* 


S19* 


S20* 


521* 

177 

522* 


523* 


528* 

17 

525* 


52*« 


527* 


528* 

3*7 

529* 

C 

530* 

C 

S3|* 

C 

532* 


533* 


538* 


535* 



JN«f < IL»2) 

00 2*71 

00 2*7 I L»l i2 , , , 

TStN,L)»TS|N»tl*TFMt»J»l-> 

CONTINUE 
00 2*7 NbIiNB 
K«f I (N» 

CONTINUE 
00 271 N«l , nB 
K«Fl (N) 

iriKtEOtOI fiO TO 271 
JNaF(Ki2) 

00 272 J«1 . JN 

RUX«RF (K .J , 1 I *U iK • J • I > 
RUT«RF(ICtJ«2***J***J*2’ 

TSlN.2l-TS(N.2»*RUZ«Ef «8.J,n-RUX»FFU.J,3l 

TSlNt3>«TSlN*2*'*BUX«FF<K*J»2l-RUT*Pf ‘iCtJ*! J 

CONTINUE 


TRANSfORN VICTORS TO RCF. BOOT PRA«C 


TXO( 1 1 «TS (1,1* 

TTO( I )«TS( 1,2* 

T20< 1 1«TS( I ,3* 

00 17 I«2tNR 
MaHI < 1 I 
K«t«l 

FEXo'(’i>«T(m.* lin*T(H,2,U«PS( I,2**T|«.3il *•fS^I i3| 

F£Y0(I>-T(N,l.2I.FS(I.l**T(N.2,2*.FS(j,2 *T N.3,2 *rs ,2 
FE20 < I *"T(m,1 »3I«FS( I .»**T(H,2.3**PS< I »2 * *T N .3 ,3 *^5 . 3 

TXOm •T‘n.**‘'*TS 11.1**T1N,2,U8TS<I.2>*T R.3,1.**T|(I,3 
TTOd * -TCn,! .2l«TSU .l**T(«.2»2**TS«l .2 *T "•3,2>»TS ,3 

TZOll * "TCm,! » 3l*TS(I •1**7(N,2,3 **TS(i ,2**T(R»3,3**T5(| i3> 
0xSl!...^M.I.*>.0XU,l.^T«N.2d>.0T,t.I**T(;l.3.l*-« 

OTO(l.ll«T(N.1.2**OX(l.t*»T(M,2.2>*OY(I,l**T(N,3,2>»02 |*|> 

oIo<!:i*-T.Nd.3.aO*«ld»*T(N.2.3..0Y(|.l**T N0.3 .02 .» 

0X0(1 ,L*.T (Mil.* 1 *0X11 •>-‘*T(N,2,1 laOYlI.t aT N.3,1 02 I it 

OYO( I,L*.TlN.l .2**OXU.U**T(H,2.2*.OY(I.U aT M,3,2* OZ .U 
020( 1 ,L*-T<Htl t3i.0X(l •U*T(H.2.3>.0 Y(Ii4.».T(M,3,3i. 02(I it) 

00 17 Ja| tNB 
IFd.EOtJ* OO TO l7 
IF(CPS( X I Jl ,E8« I * 50 TO 177 
IF (C (R • 1 * •E0» * * <*® 70 17 

0X0(1 ,J l«OxO( I »*• * 

0Y0( I ,J*.OyO< * tL* 

OZO( I .JlaOZOl I 

OXo]Mi*.TlN.*.»*.OX(I.J*.T(H,2,l*.PT(I,J*aT(H,3,l*.02(I,J* 

0Y0( I ,J*.T(H,1 ,2»*0X(ItJ**T(H,2.2>.P711,J**T(«,3i2».02UiJ» 

0201 1 •J*.7(N»* »3'.0X(l .J**T«N.2«3).0 Y(I iJ**T(N,3i3**02( I ,J* 

CONTINUE 
00 3*7 I"1 ,nB 
0X0( 1 , I *"0x( I • 1 • 

0Y0( 1 0 I *.0y (1*1* 

0Z0( I • I **0z (1*1* 


CONFUTE T0T»L E*TERNAU PO«C€ 0** VEHICLE (IN "EP. COORO.l 


FTXO«0* 

FTYOaO. 

FTZOaO* 

00 287 NbI,nB 
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S3«* 


FTX0«FTX0*FE*0IN» 

S37« 


FTY0»FTy0*FE70(N) 

S38* 

297 

FTZO-FTTO^FEZO**** 

S39* 

C 


SHO* 

C 

AOOITIONAL aUSRCNTEO INERTIA OYaDICS |IN REF.hoDV FRaNE) 

5HI« 

c 


592* 


DO 37 I>1 iNB 

5H3. 


00 37 J"1iNB 

Si*!* 


IFd.SCtJI fiO TO 37 

SHS* 


0X2-0X0(t «JI*OXO(J,l 1 

S<«6* 


o«2aoro( I •j)*oyO( jti 1 

5M7» 


0Z2>0ZQ(l«j|*0Z0U,|t 

SH8* 


PS( I ,J,I ,I l•-TM•<0T2♦022l 

5<«9* 


PSU ,J, I ,2)«TH*0X0(J,I I60Y0I I iJ» 

SSo* 


PS(IiJtIi2)aTN*OXO(Ji|l«OzO(liJ) 

55i. 


PS< I • J.2i 1 )>TH*0Y0( J. I laOXOl I iJ) 

552* 


PS( I ,j.2.2»»-TH«<ox2*022I 

5S3* 


PS(I.Ji2i3|-TM«0Y0(JiI)*0Z0<1«JI 

SS9« 


psn ,j,3,i 1 -tn.ozoij.i (•oxon ,j» 

555* 


PS (I ,J,3,2)«TN*0Z0«jtI JPOYOlI ,J> 

SS6* 


PS<I.Jt3t3)«-TH*(0X2*0Y2) 

557* 


00 378 H-i,3 

S58* 


00 378 Nat, 3 

559» 

378 

PSIJ,I.H,N|aPS(I,J,N,M) 

560* 

37 

CONTINUE 

56 1 • 


DO 751 Jal.NB 

562* 


00 751 H>|,3 

563* 


DO 751 Nal .3 

569* 

75| 

PS< J, J,H,N)»PH(J,M,NI 

565* 

C 


566* 

c 

COMPUTE VARIASLE PART OF APPENDAGE INERTIA ilN SUBSTr, COORDS,) 

567* 

c 


568* 


00 236 X«1 ,nF 

569* 


XXaFlK.I)*! 

570* 


NaHKXK) 

57J. 


JNaF(K,2) 

S72« 


DO 235 lal,3 

573* 


00 235 jat,3 

579* 


VUI I ,J)aO« 

575* 

235 

VJOdtJIaO. 

576* 


00 239 JaltjN 

577» 


I 1 laMFlK.J. 1 1 

578* 


l22aMF(K,J,2l 

579* 


I33aMF(K.J,3) 

58o» 


I I2a-NF(K« J,9 1 

58|* 


I I3a-MF(X,J,51 

582* 


I23a-MF(X IJ.61 

583* 


MSaMFiK, J,7 1 

589* 


RiaRFU.Jd 1 

58S* 


R2aRF«K,J»2t 

586* 


R3aRFU.J,3 1 

587* 


UlaUIK,J,l 1 

588* 


U2au(K ,J,2) 

589* 


U3aU(K ,J,3) 

590» 


8| aeiK , Ji I ) 

59i» 


a2-8(K,J,2) 

592* 


B3a8IK , J.3) 

S93« 


Vjl 1 ,1 )«yJd «1 )*2.a«RS-*(R2»U2*R3*U3»-Il2a83»II3«B21 

599« 


Vj(2,21aVJ(2,2)*2.aCMS»IRl»UdR3«U3)-l23«Bl*I12»B3) 

S9S« 


VJ(3,3)aVJ(3,3»*2.»«MS»(Rl»Ul*R2«U2>-Il3»B2*123»BII 

596* 


VJ(!,2)aVJ(|,2l-MS»«Rl aUZ^RZaUl )-I 1 Sagl ♦ 1 23 »B2 -83 • U 2? - 1 1 U 

S97» 


VJ(1.3|aVJ(| ,3) -M5»( RI auS^RSaUl 1 ♦! 1 2*6 1 " 1 23*a3-B2» I H 1 ”133) 

598* 


VJ(2.3)avJ(2,31“MS«(R2*U3*R3au2l-I I2«82*113»a3-8l»( 133-1221 

599» 


U1 auo <K t J • 1 1 

600» 


UZaUOUf J,2) 

601* 


U3aUD(K,J,3l 

602» 


BlaaOlKtJ, 1 1 

603* 


32aBD(K.J,2> 

60 9 • 

• 

a3aB0( K ,Ui3 1 
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60S* 

606* 

«07* 

60 S* 

609* 

4|0* 

6U*. 

6ia* 
61 J* 

61 h* 

6jS* 

616* 

617* 

618* 

619* 


VjOt 1 I ll«Vjo(l . 1 1 * 2 .* <«S*»l»2*02*R3*y3*-n 2*83*1 J3*8i) 
VJO(2i2l"Vjo<2»2)*2.*«HS»«Rl*Ul*R3*U3)-I23*Bi*l 12*B3) 
VJO(3»3 I“Vjo< 3|3I*2.*(HS*<R1*U1*«2*U2I-I 13*S2*(23*B1 I 
VJOI 1 i2l*Vj0 « I i 21-MS*‘R|*U2*I*2»UI > “ H 3*8 1 ♦ I 23*B2-83» C 1 22- 1 H 1 
VJO< ! ,3»»Vjo( I «3 >-nS*<RI*U 3*R3*01 »*n2«fll-l23*B3-B-2*( 1 11-133) 
239 VJO<2i3»«Vjo ‘2.31 -hS*«R2*U3*R3*U2I-1 I 2»B2* 11 3*B3-B I • U 33-1 22 1 

VJ12 , l.»*VJ { 1 ,.2_) _ _ 

VJ13 , 1 >*VJ ( 1 i3) 

Vj»3.2)*Vjf2,31 
DO 99B 1*1 ,3 
00 995 J*1 ,3 

99s PSlKKiKK t 1 , J I ( KK , KK • 1 • J 1 *V J i 1 • J> 

VJ0(2t I l*Vjo< 1 |2) 

VjO(3>li-Vjo(li3l 

VJO(3i2)*Vjo<2t3) 


620* 

C 



621* 

C 

convert inertia matrix to ref, boot coords. 


622* 

c 



623* 


IF (KA,EO, 1 1 60 ro 2370 


629* 


00 237 J*1 ,3 


62S* 


00 237 1*1 ,3 


626* 


ACU.I )-0< 


627* 


00 237 L*1 .3 


628* 


ACIJ.l )*AC(J.I )*VJD(J.LI*T|N,L,I ) 


629* 

237 

CONTINUE 


63o* 


00 238 J*1 ,3 


63|* 


DO 238 1*1,3 


632* 


VJOOlK.Jil )aO, 


633* 


DO 238 t*l ,3 


639* 


VJOO(K , J, I laV JOO(K, J, I I*TIH,L,J)*AC(L,1) 


635* 

238 

CONTINUE 


636* 


60 TO 236 


637* 

2370 

CONTINUE 


638* 


DO 2371 J*),3 


639* 


DO 2371 1*1 ,3 


69q* 

2371 

VjOO(K.J,l|aVUO<J,II 


691* 

236 

CONTINUE 


692* 

C 



693* 

C 

transform au6«enteo boot INERTU otaoics To 

REF, boot frame 

699* 

c 



69S* 


DO 363 1*2. nB 


696* 


MaHI ( I I 


697* 


DO 369 J*1 ,3 


698* 


DO 369 K*1 ,3 


699* 


AB(J,K)*Q, 


6So* 


00 369 L*l,3 

. 

6S 1 • 


A8«J,K1*ABij,M*PSU ,l .J,L)*T(M,U,K) 


652 • 

369 

continue 


653* 


00 365 J*l ,3 


659* 


00 365 A*1 ,3 


655* 


PSII ,l ,J,X)aa, 


656* 


00 365 L*l .3 


65 7* 


PSII,I,J.K)aPS(t,|,j,KI*TlH,L,J)*AB<L,KI 


658* 

365 

CONTINUE 


659* 

363 

continue 


660* 

C 



66 1 * 

C 

COMPUTE the P<iS0,6PS0, ANO OOSO VECTORS FOR 

EACH FlEx, append 

662* 

c 



663* 


DO 208 K*l ,nT 


669* 


KK*F(<, I I*I 


665* 


MaHI (KK ) 


666* 


JNT*f(K,3) 


667* 


00 207 1*1,3 


668* 


CV( 1 1 *0, 


669* 


DO 207 J*I,jNT 


670* 

207 

evil )*CV ( 1 )*0LKR IK , 1 ,U>*BT (K , J)*DLK l(Kil|U)*ET(K,j) 


67 j * 
672* 
673* 


IFlKK*Ca< 1 I 60 TO 2Q90 
DO 20 ^ 1 ■! . 3 
PgSO JK , I 1*0. 
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879# 


87s# 


878# 

. 

877# 


878# 


879# 

209 

88Qa 


88 |« 

2090 

882 # 


883 * 


889# 


885 * 

2091 

888# 

208 

887# 

C 

888# 

C 

889* 

C 

890* 

C 

89). 

c 

892# 


893# 


899# 


895# 


896# 


897# 


898# 


899# 

28 1 

700# 


701# 


702# 


703* 

97* 

709# 


70S# 


708# 


707# 


708# 


709# 


710# 


711# 


712# 


713# 


719a 


71S# 


7)8# 


717# 


718# 


719# 

23q3 

720# 


721# 


722# 


723# 


729# 


72S# 


728# 


727# 


728# 


729# 


730# 

982 

731# 


732# 


733# 


739# 


735# 


738# 


737# 


7sg# 


739# 


790# 


791# 


792# 



fiPSOIK.|)*0< 

00S0(K«1>*0* 

00 209 J«l ,3 

^CSOcK.l l■P6S0(K,| )*(«HcK(K,J) I 
OPSOIK. t )"6PS0IK,l t >«C-HCKO(K,jn 
OOSOlK . I l■OOSO(K, I |«T|N«J, I laCVI Jl 
SO TO 208 

continue 

00 2091 i>| ,3 

^GSOiK.I ) a.PCK(K,| I 
GPSOIK, I t«<MCKO(K. I I 
OOSOIK, M>CV( I > 
continue 

VECTOR CROSS RROOUCTS OCSCRlBtNf, STSTEN ROTATIONAL COUPtlNe. 

(OijAORaTic terms involving the connecting boot angular 
velocities ano The mutual baRTcemter-hinge vectors) 

00 281 Ka| , nP 
I«P (N • I 

OuXa«ZO(l (•pGSOlK.Zl'ilTOM i•PGS0|Kt3) 

OUTawXOd i•PGS0(K,3).WZ0(l )•P6S0(K,1 > 

0UZ"RTOI I l•PGSO(K•l loRXOi I )•PGS0(Kt2) 

OUXOIK >-«rol I l•<0UZ•^••GPS0(Kl3> I-Rioi I > • I oUV-2 . aGPSo < K .2 * > 
OUTOIK laRZOI 1 > • ( 0UX>2 • aSPSO I K 1 1 I ) -RAO 1 1 I • I DUZ*2 . *GPSo I K , 3 1 ) 
OUZO(Kt>«Xol I )•(0UV.2••6PS0(K>2> >>RYO( I > • I 0UX>2 • *GPSo ( K i 1 1 ) 
00 230 Nal.NB 
l•PI^N) 

00 978 jal.3 

CR«OlN«U)ao. 

CPXaQ. 

CPyao» 

CPZaO, 

CPPXaO. 

CPPTaO« 

CPPZaO. 

OCPXaO* 

OCPTaO. 

OCPZaQ* 

00 2301 Lat.NB 
iLaPi ILI 

ir(lL«CO<Ol GO To 2303 

OCPXaOCPX«orO(NtLMOUZO( IL)-OZO(N»LlaDUYOI ID 
OCPTaOCPT*OZO<N,L)«OUXO| lD»OXOlN,L)aDUZO| ID 
OCPZaOCPZaoxOINtLIaOUTOlILCoTOlN.LIaOUXOI ID 
CONTINUE 

NOXa«rO(LI«OZO(L.NI-NZO|Li*OTOIL,NI 

■OTa«ZO(Li« 0 XOIL,N|.NXO|L«aOZOIL,NI 

*OZa«rXO(L)*OTOa,NI-NrO(LlaOXOIL,N) 

»WPOXa«yolLiaROZ-8ZOILla«Oy 

N«FOTa«ZO(Ll*ROXa«XOILl«l«OZ 

■ «POZa*XO(LI«ROr.«YO(Da>OX 

IMI<E9«0> gO to 982 

CR«0|N, I |aEB«0(N,| I^MRrOX 

CBMOIN.ZIacBROIN.ZIaNNPDT 

C8R0|N.3>acB80(N,3|aR«FDZ 

continue 

CPfXaCPPXa««rOX 
CPPTaCPrTaiBPOT 
CPFZaCPPZamPOZ 
IF(N.C4«L) GO TO 2301 
««OXaTNaRNEoX«FEXO((.) 

•ROTaTMaBNFOTaFEyoit) 

«8OZaTNa«RF0Z*FEZ0(L> 

OBGOXaOTO I N .D •■NOZ'OZO IN iL > a«80y 

08*0yaOZ0<N.Ll**«0X-OX0(NtLla*80z 

08NOZaOXOlN.L)a8«oy.OT01N,U>a«GOX 

CPXacPX«0*B0A 

CPTaCPyaOBBOT 
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793* 


CPZ.CPZ*0*NOZ 


2301 

CONTINUE 

7<IS« 


OFX.oTOIN.N|.TCZO(Ni-OZOtN,N|.FEYO<N| 

794* 


OFY.OZOlNtNl'I^eXOlNI-OXOlN.Nl.FEZOlN) 

7«I7* 


OF-Z.oX 01 NiN)*TEYO(N)>OYOIN,Ni.FEXO(N) 

7<»8« 


HX.PS<N*Ni 1 . 1 i.«XolNl.PS<NtN.l •2l.8Y0lNl.PS<NfN,l .3>.*Z0(NI 

_ _ f _ 


H Y.PS In .N f 2 , 1 > .8X0 IN 1 ♦PS IN ,N ,2 ,2 ) .» TO ( N ) *PS (N-tN ,2 >3 I .8Z0 IN J. . . 

75q* 


HZ*PSlNiN>3tl>**30lN)«PSlN.N.at2).MY0<Nl«PSlNiN|3i3).«Z0IN| 

75|. 


IFII.CQ.OI g8 to 273 

75,. 


HXO.yJoOl 1 , 1 il l•«XOINI♦VJOOl I tl t21*8TOINI.VJO0l 1 , 1 ,3|.«ZUlNl 

75,. 


HYQ.VJOOl 1 ,2il l•«X 0 IN>♦V• 100 ll •2.2t*WY0lN)*VJ00l I ,2,3).«Z0In1 

75<|. 


HZO.yJOOl 1 .3 t 1 )••XOINl♦yJOOlI t3»2).8Y0IN)*yJ00< 1 ,3|3|.«Z0lNI 

755* 


FACT.NS8INI/TH 

75*. 


ftxh.ftxo.fact 

757. 


FTYNaFTYO.T-ACT 

758. 


FT2N.FTZ0*FACT 

759* 


PfiFX.IPSSOl I t2|.|F6Z0INl-FTZN»-P6S0ll ,3 ».IfEY0(N)*FTyH) I/HS8IN1 

7«0* 


PSFY.IPcSOll .3).|FexO(N).FTXNi«PGSOII • 1 1 . IF^ZO (N I -r TzN ) ) /MSB |N | 

7*|. 


P 6 FZ.IPGSO 1 1 il i•lFEY0IN|■•FTYN>•P6S^I I |2 1 . 1 FEXO 1 N|*FTxN ) )/HS8|N) 

7*2. 


P««0X.P6S0( 1 •2|.CPFZ-P«S0I I >3i*CPFY 

7*3. 


P«80Y.P6S0(l |3|.CPFX*PGS0lt tl l.CPFZ 

7*<t.‘ 


P8«02>P«S0(I «1 |.CPFY«P6S0I| i2)*CPFX 

7*5. 


«OOSXO>«YQ(nI*OOSOII •3>.«Z0In).D0S0I I «2I 

7*4. 


*OOSYO>«ZO<n)*OOSOI I . 1 ).«XOlNl*OOSOI I |3) 

7*7. 


WOOSZO.aXOlNl'OOSOl 1 •2I.8TOIn 1*OOSOI 1 »n 

7*8. 


60 TO 277 

7*9. 

273 

CONTINUE 

77q. 


HXD.Q. 

77 1. 


HYQ.O* 

772. 


HZO.Q* 

773. 


P6FX.0. 

779. 


P6FY.0* 

T7s. 


P6FZ.0* 

774. 


PaNOx.O* 

777. 


P8N0Y.0* 

778. 


P«N02*0* 

779. 


NOOSXO.O* 

78q« 


800SY0.0* 

r«i. 


•OOSZO.Of 

7*2. 

279 

continue 

78,. 


X • 3 . IN. 11 

789. 


E IK*I • 1 I.Mv« 8 ZOlNi.rtZ.*TOlNl.tXO|N>.CPX.OFX.HXO.P 6 FX.P« 80 X. 800 SXO 

78s. 


•♦OCPX 

784. 


EIX.2i1 I.H2.«*0IN|.nX.82OIn1.TYOIN1*CPY*0FY-HT|).P6FT-P880T.8OOSTO 

787. 


•♦OCPY 

788. 


ElK*3il i.HX.aTOlNl.Hy.KSOlNl.IZOINl^cPZ.DFZ'HZoTPGFZ.PINDZ.BOOSZO 

789. 


S.OC^z 

77q. 

23o 

CONTINUE 


C 


772. 

c 

AOO NATNIX ELEnENT COMPUTATION 13X3) 

793. 

c 


779. 


00 3001 |.| .3 

775* 


00 3001 U*ii3 

774. 

3001 

AOOl I fJI«0. 

777. 


00 3 l.IfNg 

778 . 


00 3 J.| iNB 

779. 


*001 If 1 I.AoqI 1 , 1 1.PSI If Jf If 1 1 

80q. 


AOOl 1 f2I.Aool 1 fZI.Psi TfUf 1 fZ) 

80 1 . 


AOOl 1 fZi.Aool 1 f3)*PS(l ,Uf| ,3) 

80,. 


A00I2 tZI.AOQlZfZl.psI I f Jf2,Z| 

803. 


A00l2i3).*00lZ,3)«pslIf J.2,3) 

809. 


AOOI3f3|.AOO(Zf3I.fSll fVf3f3) 

805. 

3 

CONTINUE 

80*. 


AOOlZf 1 I.AaQll fZ) 

807. 


A00l3f 1 >.AooH f 3 | 

808. 


AoOI 3 f 2 ).Aool 2 f 3 ) 

807. 

C 


8l Q. 

c 

flex, append* contribution To AOO MATRIX COMPUTATION (3X31 


c 
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812a 



813a 



81H* 



BlSa 



81G* 



817* 



818* 

2103 


8|H* 



820* 



82i» 



822* 



823* 

82H» 



825* 



826* 



827* 



828* 



82V* 


• - ; 

830* 


I 

831* 



832* 


' -Cl 

833* 

2101 


83H* 



835* 



836* 



837* 



838* 



83V* 


r-' 

8HQ* 


'' : 

a H 1 * 



8H2» 


- _ 1 

8H3* 



8HH* 



8H5* 



8H6* 



8H7* 


HI 

8H8* 



8HV* 

2102 


8S0* 



851* 


; 

852* 

21H 

* j 

8S3* 


* 

85H* 



855* 

215 


856* 

210 


857* 



858* 



859* 



860* 


'T-4, 

86 1 • 



862* 

2IH1 


863* 

2151 


86H* 



865* 



866* 

867* 



868* 



869* 



870* 



87l • 


' 'J 

872* 

3003 


873* 

300'« 


87H* 

C 


875* 

c 


876* 

c 


877* 

c 


878* 

,c 


879* 



880* 



00 2|0 Kal.NB 
ICKaf I (1C) 

00 2I0 L-I.NB 
IFCK.GT.L) fiO TO 2 iq 
DO 2)03 la). 3 
00 2|03 Jai«3 
PSF(<»I.>1 iJjaO. 

LLaFt (LI 

IF(KK«eQ«0| GO To 2tOI 

OPiapQSOdCK.l >«OXO(LtK) 

0P2apaS0(KK,2l«0Y0(L«K) 

OP3aPGSO(KK,3)*DZO(LtKI 

PSF(k,L.I 1 1 |a-0P2-OP3 

PS(f (F,L,2,2)«-0P1-0P3 

PSF (K iL i3 t3 > •-0PI-0P2 

PSF (1C iL I 1 i2l"'’GS0UK »2la0X0(L .K I 

PSF(Ki(.iI •3)**’0S0(KK«3)*0X0(ttK> 

PSF (k «L i2 1 1 laPGSOIKK (DaoTolLtK) 

PSF (K >L*2O)aPGS0(KX>3)*0T0(LiK) 

PSF(KtL«3,| laPGSoiKKtl )aOZO(LiK) 
PSF(KiLt3i2l*P6S0lKK«2)*0Z0lL>Kl 
continue 

tF(LL>Ca«0| GO TO 210 
IF(K.eq.L) GO TO 2102 
POl«PGSO(LLt 1 ••OxO(K»Ll 
P02apGS0(LL.2>*0r0(K.LI 
P03apGS0 (LL .3 laOZOCK .L ) 

PSF(k »L« I . 1 » "PSF (k.L* 1 • 1 )•P02-H03 

PSF(K.Li2.2l*PSF(x,t.2,2)-P01-PD3 

PSF(|c,i..3,3l«lPSF<K,i.,3,j)-p0i-P0 2 

PSF(k.L. I »2 l■PSF(K,^.,l .2 »*oT0(K.U»»P6SO(LL, 1 • 

PSF<XiL*l .3)*^SF(|C,i.,l •3)*0Z0(K«L)*PGS0(LL«1 I 

FSF(x ii. ,2. 1 I ■PSF(k ,t *2.1 1*0X0 (K iL ) *PCSO (LL 1 2 ) 

PSF(k«L» 2«3 l■PSF(K.L•2*3>♦DZ0(K.Ul•P5S0(^L^2) 

PSF(k,u.3,| )«PSF(k,li 3,1 l♦0X0(K.U•PGS0(LL.3) 

PSf»K .L.3,2)«PSf(K,L.3,2I*OT0(IC,L)«PgSO(LL,3) 

SO To 210 

continue 

00 2|*( la|,3 

00 2|‘( ja(,3 

*8 ( I , J) aPSp I X ,L » I , Jl 
00 2lS )a|,3 
00 2|S Jal,3 

PSF (K iL . I t j ) aABC I .JIaABI J, I ) 

continue 

00 2|SI Xai.NB 

00 21S1 L-i ,N3 

lF(K.LE.LI gO to 2ISI 

DO 2|‘M la|,3 

00 2| HI ja| ,3 

PSF (X »L , I ij laPSFlU tX ,J tl I 

CONTINUE 

00 300H Xa| (NB 

XXafi (K) 

00 300H L«1 ,NB 
LLaFi (LI 

IF( (XK.EQ<Ol •ANO.ItLtEQtOI I GO TO 300H 
00 3003 Ia| ,3 
00 3003 ja| ,3 

Aool I t Jl"*00< I iOI>PSF(KtL< I tJ) 

continue 

CONTINUE 

AOK VECTOR element COMPUTATION (3X11 

XXM SCALAR element COMPUTATION 

Oo IH Ma|,NH 
ISaH(MI*l 
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88|« 


AVlAtl)*0* 


'^1 

882* 


*VlH.2)>0t 

r- 


883* 


Atf(H,3)-0t 



88H« 


DO 7 J*1 iNfl 



86S« 


00 7 1*IQ*NB 



886* 


00 11 N*l«3 


- ' 

- 887« 

— 

IFIEPSIM, 1 1 .E'JtOj-SO TO- 7 - . . 



888* 


PSfil j,l ,N)«0* 


■ 'T;‘i 

889* 


00 10 L*l i3 

V 

■'?3 

89a* 

10 

P5q( j, I .NI*PS6( J, 1 ,Mi*(PS( J.| «N,L >*PSF 1 J 1 1 iN|L) >*60|M,t 1 



89 1 « 

1 1 

AV,M,N,-AV|M,N1*PSSU,1 ,N» 


■rV:.- 

892* 

7 

CONTINUE 



893* 


00 14 K*1 iNH 


-Kj-y 

894* 


IpCK.ST.Ml S® TO ,4 

t 


S9S* 


jq*H<K,*| 

r 


898* 


A1S( 1 )*0« 


' " 

897* 


AIS12)*0< 

j.' 

SI 

898* 


<IS(3t*0« 


■- 

899* 


DO IS J-<J4.NB 


■'S3 

900* 


00 15 lalQiNB 

k 

••sj 

90 1 • 


IFM epsiK, ji .eq.ot .OR. (CPSiH, n .EO.oi 1 so to is 



902* 


00 18 N*1i3 

J 


903* 

18 

AtS(N>BAtS(N)*PSQ(J,t,N) 


'M 

90M* 

15 

CONTINUE 



90s* 


ASIK,H,*G0(Ki 1>*A1S(1 l*«0tlCi2) *AtS( 2)*60|K ,31 *a1S(3> 


''i-’fi 

906* 

1*1 

CONTINUE 



907* 

C 




908* 

c 

AOFl and AOFR matrix C OMPUT A T 1 ON , 3XNK T ) 


'".’j 

909* 

c 




9 1 Q* 


DO 2,9 K*1 ,nF 


S'?” 

9U* 


JK*F(K,3» 



912* 


JQ*F , A ,11*1 

J. 


913* 


00 222 1*1,3 


S;?; 

9>4* 


00 222 J*1 .3 



915* 

222 

A8( 1 , J)*0. 


•; •»! 

916* 


00 221 L*1 ,nB 

> 

■'■H 

917* 


ABI 1 ,2)*A8( 1 i2 )**OZO(L lUQ 1 



918* 


A8<l,3t*AB(,t3)*0Y0<LiUQ* 

j; 


9 19* 

221 

AB(2,3l*A8(2i3)’‘0x0(L«Uql 


.-i-' 

920* 


A8(2,l )**AB( I i2i 



921* 


Ae<3'.l )b«Ab( I 



’22* 


A8(3.2i*'>AB(2i3) 



923* 


00 220 1*1,3 



924* 


00 220 J*l,.jK 


'\i 

925* 


AOFR(K,I , J)*0LAR01K, 1 ,J| 



926* 


AOFl (K . 1 ,Jl*OLK IO(K , , ,J | 


-'H. 

927* 


00 220 L*1 ,3 


■"■'■4 

928. 


AOFRlK, ] , J)*A0FR(K, 1 , J) . An(I>L).GKOSIX,L,U) 


' ' r/j' 

929* 

220 

AOFl (K , I ,J)*A0F1 U ,1 , Jl - AB (1 ttl *PKOS IK >L |UI 



930* 

219 

CONTINUE 


. ••“ 1 

93,* 

C 



-* .i-;^ 

932. 

c 

AKFR vector computation (UHkT) cFLE*. coupling «|Th rigid substructure 


\--5 

■:0 

933* 

c 



•r’vl 

934* 

c 

AKFI vector computation IIXNkTI 1 FLE X ,c0UPl I NG BITN rigid substructure 



935* 

c 




936* 


00 224 K*1 ,nF 



937* 


JK*FIK,3) 



938* 


J8*FlK,l 



9 39* 


00 2295 0*1 ,JK 



94q* 


ZSR(Ki0l*0. 


■'^A 

94, * 

224 i 

Z5I (Ki0l*0. 



942* 


00 229 M*1 ,nH 


'•■•' 3 

943* 


00 231 1*1,3 


*i 

944* 


00 231 0*1 ,3 



94S* 

23, 

ABI I ,0l*0* 



946* 


00 228 L*1,nB 



947* 


lF<EPS(M,Lj ,EU.0| go to 226 



948* 


AB-I 1 ,2 1 *AB( , i2 l^OZOILf oql r»'^ ^ 


$1 

949* 


ABI 1 ,3I*AB| 1 ,3I*0T0IL«0«I t' 
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950* 


Ae(2t3)*A8(2t3»-0X0(L«-IQI 

95l» 

226 

CONTINUE 

952* 


*812, 1 1 t2> 

953* 


A8( 3, 1 ) *-An( 1 «3> 

9S<4« 


AB(3,2>*-AB(2>3) 

955* 


00 228 1 •! ,3 

956* 


00 278 J*l,jK 

9s;» 


OURI 1 iJiaOtKROU.I tJI 

958* 


out ( I iUt*OuK tOIK , 1 , jt 

959« 


IF 1 CPS IN ,K 1 .C2«ai 0UR(tiJI*0. 

96q* 


IFIEPSIN.M ,eQ*QI OUtdiUlaQ. 

96 1 • 


00 228 L*l,3 

962* 


OUR I t , J ) *OUR lltUI-ASIltLIasKOSlKiLtUI 

963* 

228 

OUl ( I ,JI*Oui (l,U)>A9lliLi*PK0S(K,L,J> 

96<*« 


00 229 1 J* 1 . J< 

965* 


00 2291 1-1,3 

966* 


2SR(K,JI-2SR(R ,U I *008 I I ,U ) •WgUI'I 1 1 > 

967* 

2291 

2SI<K,Jl*ZStd»JI*0UtlI»d»*NSJlll»II 

968* 


00 229 J*l ,jK 

969* 


AKFR (K ,N , J 1 aO, 

970« 


AKpl (K,N,U|aO. 

97 1 • 


00 229 1*1,3 

972* 


AKFR(K,H,JtaAKF8lK,r1,j)*G0(N,t)a0URI I ,J> 

973* 

229 

AKFt(K,N,JtsA<Ft(K,N,J)*GO(N,I>*OUllt,J) 

97<«* 

229 

CONTI NUe 

97S* 

C 


976* 

C 

cQHPuTE correction elehents for t£l tector 

977* 

C 


978* 


00 9| J*2iN6 

979* 


UKaHt I J) 

98o» 


00 9|| Hal, 3 

98 J • 

111 

C«(U,HI*0< 

982* 


00 92 K*1.JR 

983* 


IFIEPSIK ,J J ,Eq.O| GO TO 92 

989* 


C«< J,t >*CA( Jil ) 

985* 


C«(j,2)*C<Mu«2t*N6J(K,2» 

986* 


C«l J,3 )*C<I(Ui3>*WGJ(iC,3) 

987* 

92 

CONTINUE 

988* 

91 

CONTINUE 

9«9» 


00 90 1*1, NR 

99o« 


EAI I )aU« 

99 j • 


EAI2 1*0, 

992* 


EA I 3 1 *0 < 

993* 


00 901 J«2.n8 

999« 


00 9507 N*i,3 

99S* 


00 9507 L*| ,3 

996* 

9507 

EA(NI*EA(N|*IPSII,J,H,L)-PSFI I ,J,n,L>)*C«|J,L| 

997* 

•*01 

CONTINUE 

998* 


K|*3*l I-l J 

999* 


E IK 1 , 1 l*C (K> * t • 1 )-E*< 1 > 

1000* 


C|K|«2,t)*ClKt*2,| I.EAI2I 

lOOl* 


E|K|*3,| l■EI•<^♦3,^ I-EAI3) 

1002* 

90 

continue 

1003* 


00 55 HI-1,3 

IOOh* 

SS 

ECIHI l-ElPl ,1 > 

toos* 


00 S2 J«2,NR 

t006* 


00 52 M«l ,3 

1007» 


K|-3*IJ-ll*M 

1008* 

S2 

ECIH)-ECIH)*E(KI ,1 1 

1009* 


I-O 

1010* 


00 60 K-I,NH 

toil* 


JK-H 1 K ) * 1 

1012* 


IFIPl IK ) «Ne.O) GO TO 60 

1013* 


1*1*1 

lOlH* 


ECl I«3)*0t 

lots* 


00 80t H-l ,3 

1016* 

*01 

CEIHI-q. 

1017* 


00 6| J*JK,nB 

|0I8* 


IF(EPSIK,J|,EQ»0) go to 6l 
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l 02 o* 


Jl *3« ( J“1 ) 

| 02 l» 

65 

CE<H)*CEIH)*e< J1 ill 

1022 * 

61 

CONT I NUE 

|023« 


00 66 L« 1 1 3 

| 02 H» 

66 

EC ( 1 *3 ) *EC ( 1 *3 )*S0 (K ,L) *CE(L ) 

1025* 


ECl 1*3»«EC( i*31.*Tm<'C> - . _ 

1026 * 

60 

CONT t NUE 

I027» 


00 610 1*1,3 

I02b* 


00 610 J*1 ,nH 

1029» 


IF (PI (Jl .E q.O 1 SO TO 610 

1030* 


ec(I)*e:c(1i-av(J,ii •snoou) 

|03i. 

610 

CONTINUE 

1032* 


K *0 

|033» 


1 V*3 

103b» 


00 612 1*1 ,NH 

I03S* 


1F(PI I 1 ) (Nc.OI SO TO 612 

1036* 


K*K* 1 

1037» 


1V*IV*1 

t03e« 


00 61 1 J*1 ,nH 

1039« 


1F(P| ( Jl •EO.OI SO TO 6 l 1 

lOHo* 


IFd.ST.JI aS( 1 tJI*AS(Jf 1) 

lOli. 


EC(K*3l*EC(K*3l-ASIt ,Jl*Srt00(JI 

10<42» 

6 1 1 

CONT 1 NUE 

lOMj. 

612 

CONT 1 NUE 

10H<4* 

C 


I0‘<S« 

C 

compute NT. hand side OF aPI'ENOAGE equations (IN APf*ENOt COOROStI 

10 M 6 * 

C 


1017* 


00 <177 K*i ,nP 

1098* 


00 <179 1*1,3 

10H9* 

H79 

COU(Kit 1*0, 

lOSo* 


00 <178 L*1 ,NF 

|0S|. 


IF(K.EQ.LI go to <178 

1052* 


COU(K.2I*COU(Ki21«OUYO(LI 

1053* 


C0U(K 1 1 l*COU (< • > >*OUXOIL > 

1 05*(« 


COU(Ki3l*COU<K<Ot*OUZOlL> 

loss* 

<(78 

CONTINUE 

10S6* 

<177 

CONTINUE 

|0S7« 


00 <183 K*1 ,nF 

1058* 


I*F(K , 1 1*1 

1059* 


M*HI ( 1 1 

1 06a* 


CQ ( 1 I ■ (FTXo*COU (K , 1 1 1 /TN ♦ CWWOlI.ll 

1 06 1 • 


C«(2I*(FTTo*COU(K, 2) l/TN ♦ C»l«101I,2l 

1062* 


CQ(31*(FT2o*CDU(f,3I I/TN ♦ C6N0(I,3I 

1063* 


IFd.EQ.II GO TO <ts<10 

1 06 <t« 


00 <18<1 J*l ,3 

106S* 


VE(K , J l*-"woE<K iJ 1 

1068* 


00 <18<1 L*l,3 

1067* 

88<t 

VE(K,J1*VE(a,JI*T(N,J,LI*CQ(L1 

1 068* 


GO TO <183 

I 069* 

<« 8 h 0 

CONTINUE 

107q» 


00 <ie<ll j*t ,3 

I07l* 

<I8<11 

VE(K,JI*C9(jl-*»0EUtJ> 

1072* 

<183 

CONTINUE 

J073* 


00 <18S K-1 ,nP 

107h* 


NL*F(K,2) 

1075* 


I*F(Ki 1 1*1 

1076* 


N*H1 ( 1 1 

1077* 


Rl*S«(K,l 1 

1078* 


R2*SR(K ,21 

I 079* 


R3*SR(K,3I 

1 oeo* 


IFd.EOdl G° TO <1870 

lOflj* 


00 <187 J«l ,3 

1082* 

<187 

*11»(Jl*T»M,j,ll*l«XO(II*T(M,Jt2)**lT0d>*T(H,J,3l*»Z0dl 

1083* 


GO TO <1872 

I08<t* 

<1870 

CONTINUE 

1085. 


Ntt( 1 1 *«XOI I 1 

1086* 


«N(2l*«Y0lll 

1087* 


W«(3l*WZ0ll 1 

1088* 

<1972 

CONTINUE 
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089» 


09q* 


09l« 

' 

092* 


093* 


094» 


4)95# 


096 • 


097* 


098# 


099# 


100# 


|0] • 

488 

102* 


103# 


I0<4# 


105# 


106# 


107# 


toa# 


1 09# 


1 IQ# 


I 11# 


112# 


1 13# 


1 I 4# 


IIS# 


1 1 6# 


I 17# 


1 18# 


1 19# 


I20# 

486 

I2l# 

485 

122# 


123# 


124# 


125# 


126# 


127# 


128# 


129# 


1 3q# 


I3l# 


132# 


133# 


134# 

493 

135# 


136# 


137# 

494 

1 38# 


I 39# 


140# 


I'll# 


142# 


143# 


144# 


145# 


146# 

4920 

147# 

492 

1 48# 

49| 

149# 

C 

1 So* 

C 

iSl# 

C 

152# 


153# 


1 54# 


155# 


156# 


157# 



• l 1 1 1 ••2 
W22«W*I2»»*2-H2»»2 
W33»«tlM3)«*2-«3*»2 
NI2 -WW( I )*nn(2)-R|»R2 

• l3«w«( 1 )««,|(3>-R1*R3 
W23-WN < 2 > •«» ( 3 > *R2*R3 
00 <tS6 N-1 ,nL 

N6*6« ( N- I > 

DO <488 J"l ,3 

jNbN6'*J 

JM«JN*3 

ValK ,JN t aFFlK |N • J) 

Va(Kt JH>>TF(K tN> J) 

Va<KiN6*| >avBlKiN8«t I 'Hr < K « N , 7 I • ( -RT ( K • N 1 1 ) • < «33 *«22 I *RF ( K • N 1 2 > •« 1 
S2*RFlK,N.3)«Wt3) 

Va<K iN8«2) avalK »N6*2)-Hf (K .N ,7 >• (-RF Ik <N |2) • («33*«1 1 ).*RF IK |N t 1 )•«! 
S2«RF(K,N,3)«N23> 

VB Ik .N 8*3) aVBlK *N**3 »-MF Ik ,N, 7» • l-RF IK |N|3) • IN| 1 «<«22) *RF IK ,N, I J •R} 
S3«RF|K.N.2|*N23> 

CEIn* MF Ik |N • I >•»lll 1 I-44F Ik »N iH)«NN 121-HF IK *N i5 >*»Nl3 > 
ce l2 I--MFI K.Ni<4 >•««!( I »*HFIk »N.2 I••wl2 l-MFlK»Ni8)*i*»l3> 
CEl3t"-MFlK,N«al««Mi||| l.l-HFlKiNi6)*«Rl2)*'nFlKiNi3)*MNl3l 
CL I 1 ) -Hf IK ,n il ) *Rt-HF IK ,N ) •R2 >Mf (K ,N .S)*R3 
CLl2l*-HFlK,f4t'4»»Rl*HFlK»N,2)»R2-HFIK,N,6)«R3 
CLi 3 I "-MFl t(,N,5> »R|-HF Ik .N, 4 )*R2»nFlK,Nt3)*R3 
V6lK,N8«<navalKiN6*<tt.(««(2l*Cet3l-Wllt(3i*C{:(2l | 

S* (R2#CL ( 3 > .r 3*CI- (2 t I 

V8 lK.N4*5)avalKtN4«S)-li>«i3 >*cei 1 )-WV( | >*CCl3 ) t 
**IR3«CLIt»-Rl»CLl3n 

VBIK .N4*6 t avB IK <4« I 1 ) *cE I 2 ) •«* I 2 > *CE * 1 > > 

**IRI«CLI2).r 2*CLII n 
CONTINUE 
CONTINUE 
NV-I V 

00 <491 K«l ,Nf 

JN»F(K,3I 

NL"F(K,2) 

NLfcaRaNL 
00 <492 Jal ,jN 
IL«NV*J 
I 0« IL*NTN0 

Vvla(ET{K,j|*2FlK,J»ao7|K,jl)«2. 

V V2a ( OT 4 K. j I -2F I K,J I #ET I K,JJ »*2. 

00 H73 N«l , nL* 

VVtayV|aEI(K,N,U)«yg(X(N)«2* 

VV2>VV2-ER|K iNtJI*VaiKtN>*2. / 

00 99<4 Nal ,3 

VV|avV|.QK(KiN,U)aVEIKtN) 

VV2»VV2*PK(|C >N,J)ave|K>NI 
VV la.NF (K • j I •VVI'ZSRIK .U 4 
VV2>*«IP(K,U)«VV2-ZSI IK.U) 

EC I ID aW 1 

CCII0l«W2 

00 <4920 L«t ,NM 

IF IPI 4 L ) tEs.O) So TO h92q 

EC4 IL 1 >eC I IL l-*KfR(L,K,g »aGN00 4L ) 

Eel IOl»EC4 10l-*KFl4LtK,J)»GNoOIL) 

CONTINUE 
CONTINUE 
NV»NV* JN 


enter constants into FLEK. tioor portion of COEFF. matrix a 
NV»I V 

00 462 Kat.NF 
NL»F4K,3) 

00 463 I«I,nL 
IL»NV*I 

io»il*ntmo 


96 
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tsa* 

159» 

160» 

I61» 

\t>2» 

163* 

|6H« 

las* 
j 6a* 
167* 
( 68 * 
169* 
170* 
I7l* 
l?2* 

I 73* 
179* 

175* 

176* 

177* 

1 >78* 

I 179* 
<80* 
18 1* 

. <82* 

1 183* 

; <89* 

1 < 85* 

I <8a* 

I <87* 

1 < 88* 

1 <89* 

I 190* 

I 19j« 

I <92* 
1193* 

1 < 99* 
<95* 

I <96* 

I < 97* 

1 J 98* 

I <99* 
<200* 
<201* 
|202* 
1203* 
1204* 
<20S* 
|206* 
1207* 
1208* 
<209* 
<2<0* 
l2ll* 
12<2* 
|2l 3* 
1219* 
I21&* 
1216* 
1217* 
121'8* 
1219* 
1220* 
1221* 
1222* 
1223* 
1229* 
122S* 
1226* 


463 

962 

C 

C 

C 


96S 

969 

C 

c 

c 


967 1 
967 


466 

C 

C 

C 


00 463 J>< ,NL 
JL»NV*J 
•J0» JL*NTH0 
A(1L.JU*0. 

A( U.iJ0)*0. 

A((0,JLl*0. 

*no,JO)»o. - - 

lF(l«eQ«Jl A(lLiJL>a2« 

IFlI.EOtJ) 6lI0tJ0)>2* 

CONTINUE 

nv»nv*nl 

enter cOeff, 'Anich c'JUPl.e «cf* fle<* apfeno*ses Into a 

NV*« < V 

00 964 K«1 ,NF 
NL*F(K,3) 

00 46S J"1,3 
00 46 S <■! ,nU 
lL«NV*t 
I0«M.*NTN0 

A< IL .J 1 *AOfR (F . J , 1 I 
A(J.lL)*A(tL<'<> 

A( 10 «J)«AOfI (KiJ, 1 I 
A ( J • t 0 1 « A ( ] 0 • '1 1 
NV*NV«(4L 

enter cOEFf. RHlcN COUPLE SUsSTR, BODIES anO FLEx* APPENO* INTO A 
Nv«t V 

00 966 K*1 ,nF 

NL«F(K,3l 

Jl»0 

00 467 J«l ,NH 

lF(Pt < J) .N e.OI So to 467 

JI«Jl*l 

00 9671 l«i ,NL 

1L*NV*1 

10» IL*NTM0 

A(<L.J1*3I«A*FR<K,J,H 
A< 10, Jl«3 IbaKF I Ik ,U, I < 

AtJl*3, ILI>A< 1L,J(*3) 

A ( Jl *3 , 10 I .A ( 10, J1 

CONTINUE 

continue 

NV«NV*NL 

Calculate fllx, boot coupling coeff. and enter into a natRia 

NCO-I V 

00 473 L»1 ,NF 
NL-F(L,3 I 
NRO* I V 

00 474 K»l ,mF 
NR-FIK. 3) 

IF(K,EO>L) GO TO 979 
00 475 !•< ,nR 
1<«NR0«1 
<0»lK*NTM0 
00 975 Js| ,nL 
jk»nco*j 

J0»JK*NTM0 
AnK,JKI*0. 

A(lO,JK)aO. 

A(IK,JO)*0. 

A(10,J0)-0. 

Do 4750 N«l .3 

A( IK,JK l-AltK ,JK).gKOS(K ,N,I )*gK 0S|L,N,J1/TN 
A ( 10 , JK I "A ( lO, JK| .PKOSIK ,N, I }*GK0S(L ,N, Jl/TN 
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f? V.’ 

'*.*i "V--; 

■i.'iY-.V* 

IZ27» 


A( |IC,J0).A|lKiJ0»-SK0SlK,N,I|.PIC0S(t.,N,d>/T»1 


1228* 


A « 10. JOi-A mO^JOJ-PKOSK >»PKOS tt »N ,J l/T« 


122»« 

97SO 

CONTINUE 


1230» 


AUK.lKI.AtlK.dK> 

-- /■?.■> ••! 

1231* 


AUK. I0>"8( lO.dK) 


1232* 


At dO. IK |.A 1 |K .dO> 


1233* 


AldO. 10).A( ]0.d0) 

;-AVy-*i 

123<<* 

975 

CONTINUE 


123S* 

97«| 

NN0.NR0.N8 


1236* 

973 

NCO.NCO.NL 


|237« 

C 

LOAD ststeh natri* ia) kitm aoo.aok.akn elements 


1238* 

C 

• .- •;.'. .' • .i‘. 

1239* 

c 


", J 

J2**0* 


00 23 1.1.3 

-V\ 

1291. 


DO 23 d.|.3 


1292. 

23 

At 1 .dl.AOOt I .d) 


12m3« 


00 24| 1.1.3 


129H. 


K.O 


129S. 


00 29 d.I.NH 


1296* 


ir f Pt (di . ne.o> go to 29 

1297* 


K.K. 1 


1298* 


AIK. 3. I I.AvUil > 


1299* 


At I .K.SI.Avfd.t 1 

’■>^1 

|2Sq. 

29 

continue 


12S|. 


K.O 


|2S2« 


00 250 I.I.nH 


|2S3* 


Ir (PI < 1 1 .Ne.o> GO to 2So 


12S9* 


K.K.l 

' 

|2SS* 


L.Q 


|2S*. 


00 25 d.I.NH 

12S7. 


IF(PI (dl.Nc.Ol 60 TO 2S 


|2S8« 


L.L. 1 

‘'il 

|2S9« 


IFlK.GT.Lt GO TO 28 

1# 

|2«0* 


A(K*3.L.3I.aSI 1 tdl 


|2*»* 


GO TO 2S 

. .V 

12«2« 

28 

A|K.3.L.3I.A<(-.3,K.3> 


|2«3* 

2S 

CONTINUE 


1289. 

2So 

CONTINUE 


|26S« 

C 

angular hohcntun of the ststeh 


1288* 

C 


1287* 

C . 

IFIPKHH.II.NE.I) go to 8752 


1288* 


> ' 

1289* 


00 S8St |.| .3 . 

C', ■?:;;;’■ 

l27o« 


HHl 1 |.0« 


|27i. 


00 58SI d.| .3 

.^s.'.'Vc': 

>• , 

1272* 

S8SI 

HH 1 I ).HN 1 1 1 .A( 1 .dl*«0<>>) 


12»3» 


00 S8S2 I.l .3 


I27i. 


00 58S2 d.|.GH 

^,:f- .j/''-® 

. .—‘-X • 

|27S« 

S8S2 

HHt 1 I.HNII l.AVtd.l |.eNO(d» 


! 127*. 


00 S8S3 I.| .3 


1277. 


00 S8S3 K.| .NF 


1278. 


NL.FIK.3I 

ir.Vt 

1279* 


DO S859 d.l.Hl. .. 


|280* 

S8S9 

HH( I |.Hm( I I.AO fHlK , 1 .dl.OT (K.dl*AOFl (K.I .d) .ET IK ,dl 


1281. 

S8S2 

CONTINUE 

'‘'J'yf. 

1282« 


HH.SORTIHMI 1 >**2 . HHI2)*.2 ♦ HHI3J..2I 


|2«3* 

8752 

CONTINUE 

■B-ip 

l2«9» 

I26S* 

C 

C 

SOLVE STSTeh NaTRiX for reference OOoT ANG. acceleration AND HINGE 


1288* 

c 

irelativei rotational accelerations 


1287. 

c 



1288* 


M-T.V.NT2 


1289* 


1T.IV.NT2 


1290* 


Ky.I V 

^S?ai ii»i« 


CALL ChOLO|192,A,ST.IT.CC,0» ,1.0-7) 

B.C'>^"’; 

' |2»2« 


00 9i0 d. NT. 9.-1 


1293* 


IFU.LE.Vl GO TO 9|3 

v^: 

J299. 


dV.d-(V-IV| 

:^‘m !*»*• 


ECUI.ECIJVI 
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•.^. -s~;t 

'' *-L 

i 


- 

■SB: 






1296» 


GO TO 910 


|297« 

913 

CONTINUE 


1298* 


K»J-3 


. 1299« 


1 F IPt <K 1 .Ne.QI go to 911 


l300» 


EC< JI-ECIKVI 


1301* 


KV»KV-l 

■- - . _ . . 

1 302* 


GO -TO- 910 . . _ 


1303* 

911 

EC(Ji>GNOO(Ki 


1 30<«« 

910 

CONTINUE 

’ . -‘-i 

1 305* 


00 9003 1*1 ,9 

X-rS'V: 

1306* 

9003 

«00T ( 1 laEC ( 1 1 


1307* 


1 -V 

V 

1 308* 


00 9001 K-l ,NF 

"ri 

1 309* 
1310* 


NL-F (K .3 1 
00 9002 N-i.Nl 


|31 I* 


10-I*N 

A-.^rVJ 

1312* 


IL-I0«NTH0 


1313* 


OTOIK iNi-Ec( I0| 

isgy 

|31<«* 

90o2 

ETO(KtNI-Ec( ILi 


I3IS* 

9001 

I-I*NL 

'5SP 

1318* 

92 

CONTINUE 


1317* 


return 


1318* 


ENO 


01 agnostics 



ATION 

time ■ 

HH.H8 SUPS 






'-m 




>v-; 

■Si 


iSl 

^ii 

'.■^- -i-rA 
•::;>V“‘J 


CSSl*TRan«CSSC 


*-i 

i 

■■;if 

-j 
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Appendix D 


Subroutine MBDYFN Listing and User 
Requirements 


Subroutine Entry Statements 

CALL MBDYFN(NC, H, MB, MS, PB, PS, G, PI, 

NF, F, EIG, REC, RF, WF, ZF) 

CALL MRATE(NC, TH, TB, TS, FB, FS, TF, FF, GM, GMD, 
GMDD, ET, ETD, WO, WDOT, ETD, HM) 

Irqm’t / Output Variable Type and Storage Specifications 

INTEGER NC, NF, H(/i„ 2), F(n^, 3), PI(n + 1) 

REAL MB(7), MS(/i„ 7), PB(n„ 3), PS(n,. 3), 

G{n, 3), TH(«), TB(3), TS(n„ 3), FB(3). FS(n„ 3), 

GM(«), GMD(n), GMDD(/i), EIG(n/, 6n*, iV*), 

REC(«^, 6, N*), RF(fl^, «*, 3), WF(n^, N^), 

ZF(np N^), TF(n^ «*, 3), FF(nyr, /i*, 3), 

ET(/i^ AT*), ETD(«/, N,), WO(3). 

DOUBLE PRECISION WDOT(n + 3), ETDD(n^, N*) 

External Subroutines Called 
CHOLD — (see Appendix C and statement 1013) 

Subroutine Setup 
Insert the Fortran statement 

PARAMETER QC = n„ QH = /», QF = n^, NK = n^, NKT = 

(If more than one appendage is present, use the largest n,^ and Ni^ for the 
PARAMETER statement to provide sufficient storage.) 

Data, Restrictions 

n > I, n^> I, n^ > 1, n* > 1, > 1 
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ss 













!• 


2« 

; 1- * 

3* 

i ' ^ 

H* 


5» 


6» 


7» 

-- i 

8* 


9« 


10* 

ll» 


12* 

wM 

13* 


IN* 


1S» 


16* 


‘7* 


18* 

rV 

19* 

j 

20* 


2|« 

22* 


236 

m 

296 


2S6 


266 


276 


2«6 

296 


3q6 

V. 

3|6 


326 


336 


396 


356 


366 


376 


386 

i,P}yi 

396 

9Q6 


916 


926 

r J 

936 


996 


9S6 


966 


976 


9*6 


996 


506 


S|6 


526 


S36 


596 


556 


566 

tPi 

576 

5«« 




Core Storage Required 
Code: 4500 words 

Data: ~ 500 words (minimum; increases with n, nf) . 
Listing 


SUgRoUT INC HB0VrN(NC,CtMBiHA«P8><*A(StPI • NF • F . g I 6 1 RCC • Rf I "P i ) 

C 

C AOjUsTABCe oihensions 

c 

integer pm I ) «C <NC (2) 

real NB( M •NA(NC.7> iPBINC.SI tpAINCiNCtSI 
parameter aCa|.,0H«2 •uF«I (NK*I .NKT-7 

parameter N*A«A*NK«S-ac*l *¥'»■*• *».sa«3, St tl«BM I NM«GH 

parameter ST-¥*9f«NKT tSN^H^ST 
C 

c additional dimensioncd Variables 

c 

OOuBlC precision A(STtST) tBHAsSIS) 

INTEGER EPS(Q.S) ,CPS(GCtSi ,H(Q) «H1( S ) ,F |( S ) ( NF ,3 * 

REaE AOOOiS) « aB(3i 3| »AOF<QF.3tNKT) t AKF ( QF . Gh i NKT I • AS I G 1 0 1 i A V ( a • 3 I 
SiA|S(3l .CE(3) ,CK(gF ta) tCulal tCM*0«5i3t i C« « $ • 3 1 t Ox ( S t S > iDT ( S i S I t ^2 I 
SS.St .OXO(S,S) ,OVO(S,S) |020|S,s) tOLKIGF i3.NkT ) , DLKO I GF . 3 1 NkT > ,0GR«3 
■iNkT) tCAiai iEIGInFiNAKiNKT) tFEX0(S>iFCV0lS)ipE20*SliFS(St3*iG0l0t3 
S)tGG(Gt3iiG<Gt3).|XXIsittTr(S)ti2Z(S)t|xr(sl.|X2ISliir2<SliLX(SiSi 
SiLylStSl tU2<StSl <HSa(S) tMCK<GFi3> iPH ( S t 3 1 3 ) . pSS < S t S 1 3 I |PS(SiSi3t3) 
S,Pk(GF,3,NkT| ,P 6S0(GF,4I .PSF(S,S,3,3) ,PK0( QF , 3 ,NRT > »RF I NF , NK , 3 I t ^E 
*C(NFtatNKT)iTXolsltTYo(S)tTZo(SliT<Qi3t3)(TSlSi2)»DlGFiNKt3>tyelBF 
*t3i I ySlQF iN*K > iRfINF tNKTI t N63<0Ht3> t 2 f < NF t NKT ^ 1 2SR ( GF t NX T ) 1 HH ( 3 > 
equivalence <A,PSI i (LX.OXOI MLTtOVO) t ll.{»DzO| 

NBaNC*l 

C 

C OEFInE EPSlK.Ui using C 

C 

00 06 K"IiNC 
DO 86 U"2inB 

IF(K.CQ.(U.ln CPS|K,UI«| 

|F(K.LTt IU«I I I GO TO 87 
GO TO 86 
87 continue 

JOaK«l 
J 1 ■ I 

DO 89 L*JOi<I| 

IF|K,GT« (L-l I I Go TO 89 

|FMcPS(KtL*tCO*lltANO*<CIJ>itM*CQtlL'l>>) cPSlKiJl>l 


89 

86 


I 

C 

C 

C 


8 


continue 

continue 

t«0 

DO I JaliNC 

KK«C(J|2) c 

DO I K«I,KK 

L-L*I 

DO I laltNB 
EPS«Li I »«CPS< J, I j 

confute N(M-Ct DNERE l•HINGE EaBEE and C*C0nNECT10N EaSEl 


I >0 

DO 8 ja2«NB 
KKaC( J-l |2I 
DO 8 K-i ,KK 
I«I*l 
Hi J laj-l 
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101 


99* 

C 



*o« 

C 

COhPUTc »HERC UaOOT LA8CL«1 ANO 

gaNEA^EST H|N«E label 

*!• 

C- 



*2* 


Hl( M*l 


*3* 


Ml (NB)>N m 

* 



00 97 


*&• 


ini.eO.M «0 TO 97 


**• 


K1«H( 1 i 


*7» 


K2>MI i*n 




IF(KttE0*K2l «0 TO 97 


*9» 


HI (K2*l )«I«l 


7u* 

97 

continue 


7l« 

C 



7i» 

C 

0E7,n£ aNENE j»BOOT-LABEt*| ANO 

K IS APpEnOA9E*LA8Ei 

73* 

C 

(IF K-O. BOOT Has ho flex, APpEnOA«EI 

7*»« 

C 



7i* 


00 239 N-IiNb 


76* 

239 

FllNi*0 


77* 


00 2<t2 K>|,Nf 


78* 


JN«FIK,I i«| 


79» 

292 

rUJNt"K 


8q* 


NfmMf 


8l« 


nb.nb 


«2* 

C 



83* 

C 

OEFlNC substructure MASSES 



c 



«S» 


HSa< 1 |aHB(7 1 


• 4* 


00 298 N«2tHb 


87« 

299 

HSB(N**HA(N*lt7i 


98« 

C 



89* 

c 

total nunbeh of flex. aFpenoage Mooes to 

Be retained 

90* 

c 



91* 


NTn0«0 


92* 


00 941 K"IiHF 


93* 

941 

HTH0aNTM0*F<Ki3> 


9<«* 

C 



99* 

C 

ihiT|al Calculation of bamtcenTem vectors 

B«r|T* boot 

94* 

c 

ANO HIN6E POINTS 


97* 

c 



98* 


iXxMlaMbll) 


99« 


|YTM>*H8l2i 


»0O* 


IZZM >■98(31 


101* 


IXtM >•98(91 


102* 


|A2< 1 >99B(9> 


103* 


|T2<1 >«98(4> 


109* 


BHaSsU >-HB(7) 


109* 


T9>8mASSU| 


104* 


00 3s g« 2 »N 8 


107* 


|Xx(g>-9A(j-i,i» 


108* 


irr ( j>«NA(g>t ,21 


I(I9* 


|22U)-9A| J>| ,3> 


1 io» 


IXTlgl^NAlg*! ,9l 


Ml* 


lx2lOl*FA(J*i,S> 


112* 


IT2(g)«NA(J«l ,4| 


1 13* 


BHASs‘gl«9A<J-l»7l 


1 19* 

39 

th«tn*bnassIj) 


119* 


00 Ir9 1«1,Nb 


114* 


IMI.l 


117* 


00 199 g«liNB 


1 18* 




1 19» 


|F(|,E0,UI 90 TO 143 


Uo* 


1F(I,8T,U) 90 TO 70 


121* 


|FI|,EB*1> 90 TO 80 


122* 


IF(CPS( 1 1 ig) *E8*| 1 «o TO 900 


123* 

.70 

LX( 1 ,g|*PA( 1 1 ,1 1 (1 1 


129* 


LT(|,g)«PAIMiltt2l 


139* 


L2<I.J>«PA(MMI,3> 


124* 


90 To 199 


127* 

900 

continue 
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12»« 


00 *00 

»2»* 


lP(CpStKiJ>*Ea*l 1 «0 to 800 

t30« 

«ou 

continue 

I3l* 


«0 TO 199 

HZ* 

SbM 

LXIliU>'*PA(IltK*l> 

133* 


LT(|iU)«PA(||iNt2) 

|3H« 


L2ll.UI«PA|lltKi2l 

135* 


60 TO 199 

136* 

•0 

00 9g L">'Ui 

137* 


|F(CpS(Liu)<eo*l> 60 TO 101 

l38* 

90 

continue 

139* 


60 TO 199 

JHO* 

lOi 

LXI1»U>*P8(W>1) 



UTUtUl«P6<L«2l 

192* 


LZII«U)*P0(L,3T 

»•»»• 


60 TO 199 

MU* 


LX(liU)-Ot 

19S» 


LTI|,J)«0« 



LZ( 1 tO)"0« 

I97* 

199 

continue 

iiS* 


00 13 N«1(N6 

J<I9« 


00 13 J«1 *nB 

)&0* 


0»(N,U)*UX(N,U) 

J5»* 


0r(NiUi*LT<NiUl 

182* 


OZ(N*Ul>UZ(N.Jl 

t82« 


00 13 K«1iN0 

|6<l« 


OX(N,J|nOA(N,U)«(SMAsS|R)/TNi*|.X|N»R> 

188* 


0T(NtU)*0T(N.jt«<8MAsSU)/TNt*LTlNlK> 

18** 

13 

OZ(N»Ul«DZ<N.U)«<8NAsS(l(7/rN7«tZlN|E7 

187* 

C 


iS«* 

C 

calculation or aucnentep inertia otaoics poR SaCm boot 

189* 

C 


UO* 


00 3l N91tNB 

Ul* 


PHlN,| tl latXxlNl 

U2« 


PHlN,lt2|««UT<N| 

i«3* 


PH<N|1 tJla^lXZINl 

J*9* 


PH(Ni2|2la|TT(N.I 

»*S» 

• 

PH<N,2|3|a«lrZ4N| 

t9«* 


PM|N,3,3|«|ZZ(N| 

l*7» 


00 3o U*1 iNB 

)*«• 


RH(N,1 ,1 )*PH(N,1 ,1 }*8HAS8(3l*i0YlN»<ll»*2*O2iN»Ul«*2l 

J*9* 


PH|N,l ,2|«PN(N,I ,2|«|MASS|yl*0MN,U)*0T(N,g| 

I70» 


PHINt 1 •3iapN(Nt 1 t31«|NAS$(jl*OX(NtUl*02(Rljl 

I7i* 


PN(N«2i2I«PN(Ni2i21«8nA9S1u1*«0X(niU19*290Z<n*U***>* 

172* 


^N(Ni2«3l"P**(9«2«3*«BNA$S<Ul*0TIN,Vl»0Z|N,ul 

173* 

30 

PN<N<3«3l"PH(Ni3t3l*|NAS81ul»(0XlNiU)«92*0T(N»J***2l 

17*»* 


PN(Ni2«ll9pN|N.I.21 

»7S« 


PH(N,3,l|aPN(N,l,31 

J7*« 

31 

PH(Nt3|21apN<NiZ«3l 

177* 

C 


178* 

c 

OEPINE PK(3 X NET ARRATI 

179* 

c 

OEPINE OCK«TRaN$PQSC NATR|X (3 X nKT aRRAT} 

l»0« 

c 




00 Zol E*1|RP 



UNTaPIKfSI 

t«3* 


00 201 1*1 t3 



00 201 U«1iWnT 

|«S* 


PK(K,|,U|aREc(Ki|.UI 

ta*« 

20i 

0LK|K,|,U)aREC(K,|«3,U) 

|«7« 


return 

)8«« 


entry NRATE(NC,THfTB,TAtrB.fA,TPffP»69l»6RO»«aOeiEr><TO.«O.O0oT»€TO 

l*9* 


•OiNN} 

|90* 


Real Tp<«rfNKi3l iPf <6FiNK*3ltET(0p«NKTl iETo(«F*NKT'I *T»(3) •TAiNC*3l 

|9|* 


•fFBl3)*FA(NC*3l l6H<ll*6MO(lliEN00||>iTM(|}.«oBZ)i«XO(S)tRT0iS)»B20 

IT2* 


«(S|,E(S3.ll 

1*3* 


OOUILE PRECISION EC 1 ST 1 tETpOl OF »N kT 1 ,800T| y ) 

»99* 

C 


J»S* 

C 

BOOraTo>Boor CoOrOiNaTE transformation matrices 

I9«* 

C 
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;1 



»97* 


00 22S J«)iNh 


198* 


NN«2*1 


!»»• 

. 

N*hIJ>*I 


200* 


96N«SIM(6N|2H 


201* 


C«N«cOS(9n<2) ) 


202* 


C6Ht«l «*C6H 


202* 


6|aC6Hl*6U*t > 


204« 


«2.C6N1*«U*2) 


209* 


63*CfiRl*«U«2) 


20** 


S61«S6N«6(J*I ) 


207* 


9«2«S9R*9(2*2) 


208« 


962*SfiN*fiU«2) 


209* 


GIS«9l«6<2iM 


2i0* 


«2s%2*filj<2) 


211* 


92s*93*9(2t^> 


2I2« 


«l2>«l*fi( 


2t2* 


9I2«gI*«(2<3) 

~-SI 

2i9* 


C22*g2*g(2«2) 


2l$« 


AB(1 .1 laCaH^GIS 


2t«* 


«0( |,2i*S«2««l2 


2»7« 


AB1 1 .3l»*Sfi2*oi2 


2i8* 


AB(2«I i-*SS2««|2 


219* 


AB(2,2)-C6N«e2S 


22q* 


AB(2t3|*S6l««22 


22j« 


AB(2. 1 i>sa2*«|2 


222* 


AB(2,2)«*SGi*G23 


22j« 


AB(2.2l*C6H«e29 

.V 

22<l«' 


IF(2*e9*l) «6 TO 22 Sq 


229* 


Do 321 L*HN*I 


224* 


ir(epS(LiN) .c««|) so to 222 


227* 

22t 

continue 

.r: t'y*.-,. 

22«* 


«0 To 2390 

-A.! 

229* 

222 

•c’l 


2)0* 


00 324 L*|,3 


22|. 


DO 229 M*|,3 


222* 


T(jiLiN>*0* 


223* 


00 224 1*1,3 

: -r.y 

224* 

229 

T( J,L,H)*T(2,L,N)*AB|L,n*TU,l ,H| 


229« 


SO TO 339 

V’ 

224* 

2290 

continue 


227* 


00 3291 L*I'3 

‘ 

228* 


00 229) N*1 l2 

% 

229* 

229) 

T1 j,LiN»*A8<L,N» 


24o» 

229 

continue 

•',>••.5 :■'■'( 

24 !• 

C 



242* 

C 

cooNq* tranSforhaTion of 0 Vectors iTo ref, auov frame) 

.'ir,: :■. •« 

242* 

C 


.'it 

244* 


00 242 1*1 ,Nh 


245* 


00 342 J*l,3 

' > 

244* 


S0(l,J)*0< 


247* 


00 342 K*| ,2 

/V. ’ 

24a* 


S0| 1 , JI-SO) ( ,U)*TI),K,UI*SI 1 ,K> 


249* 

242 

continue 

--a 

29o* 

C 


J 

29j* 

C 

AnS, VElOCiTt components oF each boot <|N rCf, >oOr FRAME) 


2S2* 

C 



292* 


00 J 44 K*| ,Nm 

i 

254* 


SS(K,I)*SN0(kI*S0<K,1) 


259* 


SS{K,2)*4M0(K)«S0IK,2) 


294* 

244 

GS(K,2|*6H0(K)*S0(K,3) 


297* 


00 341 U*l,Na 

-■O ; v.tJ 

298* 


KV*H| (J) 

•: ; V-. V. 

299* 


NXO<W)*WO( 1 ) 


240* 


>Yo(J)*R0l2) 


241* 


«20(u)*«0<3) 


242* 


00 34 k*i,kv 


242* 


|F(ePS(K,U)*E«,0) 60 TO 24 


244* 


•Xo( 2 )*RXO(U)*S 6 <K,t) 


249* 


«ro(u)*«TO(U)*66(K,2) 
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2*«« 

247* 

2 *«* 
2*9* 
270* 
27l« 
272* 
273* 
27<|« 
27S* 
276* 
277* 
278* 
279* 
240* 
28 (• 
2 « 2 « 
2«3« 
289* 
288* 
284* 
287* 
288, 
2890 
29o« 
29 I • 
292* 
293* 
29<»» 
298* 
294* 
297* 
298* 
299* 
300* 
3UI* 
302* 
3Q3* 
309* 
308* 
304* 
307* 
308* 
309* 
310* 
3»»» 
312* 
313* 
319* 
3t8* 
3t4* 
3J7* 
318* 
319* 
320* 
32 t* 
322* 
323* 
329* 
328* 
324* 
327* 
328* 
329* 
330* 
331* 
332* 
333« 
339* 


34 

341 

C 

C 

C 


3448 

3«47 


3444 

C 

C 

C 


949 

972q 


972j 

948 

C 

c 

c 


283 

289 


2940 


«Z0(jt"l)Z0(3l*«6(Ki3) 

COnTINUC 

continue 

ANfi* VCLOClTy COnPOMCNTS AT CACH nIN 4E IIN Rrf* 8007 FRANC) 

DO 3444 N*1 fNH _ , 

Nt*N*| 

NC*H|NI*I 

NlaHIIMC) 

•HXOa«XO(MC) 

■HYOaNTOlncI 

•HzOaNZOIMC) 

1F(N|«CQ«M) 60 To 3447 
00 3448 N«N>iN| 

«HXOaWHXOa60(Nt 1 I 
•M70««HT0-68‘N»2) 

»MzO*»M20*6S(n»3) 

continue 

•6J<Ht I )*66*N<3) ••HTO«64(N«2 )*RHZo 
« 6J<H«2l*66<Ntl I •■HZO*66(N(3 )*NhXO 
«OjlNi3)*00<H.2i*NMXo«86(N»t (••MTo 

continue 

TRANSFORN PK AnO OCX TO RCF* BOOT BASIS 

00 948 K«I.Nf 

KKaF(K«n*l 

JNT8F(K(3) 

lF(KK«CO«n 00 To 9720 
N*h1 <XX) 

00 949 l■||3 
00 949 U*1>3 nT 
OCkO(K, I |U)*0* 

PKo<K>itg)«0. 

00 949 (.•l»3 

OCkO(K,I •J)«0LK0(K,| ,J)*T(H«|.,n*OLKU|t.tg) 

)*KO(K< 1 fgiaFKOIKil »g|*T(NtL*| )*FK(K»LiJ) 

00 To 948 
continue 
00 9721 l•l»^ 

00 9721 g-lfjNT 
OLKOIKt I f g>”Ol.K(Ki i tg) 

)*Ko(K.ifg)-)’KiK,i,gi 

continue 

0OHl*UTe TOT*l E^TERNAU force on each substructure UN KEPt CoOROtX 

FEXOI I )>FB( i I 
FEtOI I >*EB(2) 

FEZO( U"F8(3| 

IFIFI U I tE0*O) 80 TO 289 
IL*FIU> 

UNaFl IL i2) 

00 283 gal, UN 

FExOI n«FEXO( I l*FF Utigt) ) 

FEyOI I )«FErO( I ) *FF ( 1 1 tU 1 2 1 
FEZ0| i )aFEZO( 1 }*FFUCtgt3) 

continue 

Fsn • I )>FEX0« I ) 

Fsu .2)"FEr0n » 

FSl I ,3)«FEZ0( I) 

00 294 Na2,Ns 
X»N»| 

00 2940 U"U3 

FS|N,L)«FAiK ,U 
IF (Fl (N) •CQ*0> «0 TO 294 
(LaFl (N) 
gNaFi ILt2) 
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335* 


DO 29b 

3J«* 


00 29b {■1|3 

3J7« 

2**> 

FSI N,.| )-Fbl N| 1 1 *fF < ILi3i 1 ) 

33«* 

29* 

continue 

339* 

C 


3<*o» 

c 

COnPUTt TRA**bL« aNO ROTaT* 0 1 SFL AcEHLNT 5 OF ,ePENOA<*E SUa-dOolE* 

3<M« 

c 


3t2. 


DO 232 K-|,Nf 

3<«J. 


JNaF(K,2t 

3H<*» 


LK-FIKi3I 

31S* 


OO 233 j*liUN 

3<«6» 


00 233 I-II3 

317. 


UlK, J, I »«U, 

3<««« 


10««J-1»**«I 

3*«9» 


00 233 L«IiLk 

3&o« 

233 

U(K,J,|l«U(8,j,|)*ciailC,10,L).ET(K,U 

3bl« 

232 

continue 

3!»2» 

C 


3b3< 

C 

conPuTf c<n« Perturbation ifroh roni unoefoRheo locationi on e*Ch 

3b<«* 

c 

substructure R|TH an APPeNOaBE UOCaL COOROS.) 

3bb« 

c 


3b6* 


00 2a 2 K«ltNF 

357« 


U-FIK I I 1*1 

3b«« 


JNaF(K,3t 

3b9« 


00 2*3 |■||3 

36g* 

2*3 

RCa <K • 1 l«0. 

3*i» 


00 2Ab JB| , On 

3«2* 


00 26b lal,3 

3«3* 

2*b 

«Ck‘K»| ^•«C''U.| l-PKlAtl .J»»ETU,j) 

3b<*» 


Oo 26 * |“l|3 

3«b* 

2** 

CK|K,n-NCK(K| 1 l/NSBl IKi 

3*«« 

2*2 

continue 

3b7» 

C 


3*«« 

C 

COhPUTe ToTAt e'^TeRNAL ToRU^e or E*0h substructure ■«R*Ti |T$ 

3«9* 

C 

instantaneous C*Ht l|N LOCAL COORo»| 

370* 

C 


37|* 


00 26« L*l 

372* 

2*a 

TSI 1 «LI«TB(L) 

373* 


00 2*7 Nm2,Nb 

37<«« 


R«N-| 

37b» 


00 2*7 L*l>^ 

37«« 


TSlNiL)*TA(K.Li 

377* 


00 2*70 Nb|»NB 

37tt« 


iLaFl INI 

379» 


IFIIL'EQ'UI 60 To 2*70 

3i*o* 


JN-FI ILi2t 

3»|» 


00 2*7| ja|iJN 

3a2* 


00 2*71 L«li3 

383« 

2*7 t 

TS(N,Ll-TS|N,tl*TF IlLtJtLl 

38<«« 

2*7^ 

continue 

3«b* 


00 2*9 Na| (Nil 

3B6* 


K-FUNJ 

387 • 


|F|K.EO*OI bo TO 2*9 

38a« 


TSIN, 1 (aTSlN, 1 |*CKIK,2I*F S«N,3)*CKlK i3 ) •FSiN.II 

389« 


TS«Nt2l«TSIN,2l*CKU,3l»FSIN, 1 » -Cn U 1 1 1 ‘FSI N. 3 » 

390* 


TSIN.3l>TS(N,3t«CK<K,l I•FS(N|2>>CK<K•2I•FS(N,* t 

39l« 

2*V 

COnT fNUE 

392* 


00 271 N-ltNe 

393« 


K“F MNI 

39<*« 


|F(K«EQ«0I bg TO 271 

39!,» 


JNaF |K ,2| 

3T*» 


go 272 J«liJN 

397* 


RUX"RF <K • Jt U*U<KiJt | l 

3T»» 


RUT-RF|K,J,2l*UUtUt2) 

3»9» 


RUZ*RFlKiUi2l*U<K»Ui3) 

900* 


TSIN • 1 )"TSIN,| )*RUT*pFU (jfSi^RUZ^FFU 10121 

<40t« 


TS(N,2|aTS<N,2|*RUZ*FFlKtUt > 1 •RUX*FF I K , 0 , 3 ) 

902» 

272 

TS(Ni3l*TS|N,3)*KUA*|rF(K>Ui2)>RUT*FF(Ki0l t I 

903« 

271 

continue 
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«|0H* 

c 


<t05« 

c 

TRaNSFOSH VLcTORS to RCFf SOOT FRaME 

<I06* 

c 


<*07» 


TXqI 1 l*TSi 1 1 1 i 

«»U8« 


TTo< I >*TS< 1 121 

SOT* 


T20< 1 l«TS( 1 <31 

s tu* 


DO 17 |■2^NB - _ . 

Sll* 


H>Hl 1 I i 

S12* 


K»|-| 

S13* 


L*cUii l*L 

HIS* 


FExOI 1 1 ,1)*FS( 1 .l)*T|H,2tl )*FSt 1 ,2 I«t(h.3iI l*fSU •)> 

SIS* 


FETO(lt*T(HMt2l*FS(|tli*T(M«2i2l*FS(|t2)*TtHi2i2)*FSI||3| 

S|6* 


FC20<I)*T<H>li3)*FS(itt>*T(Mt2f3>*F$(li2**T<Nt3i3>*FS(|i3| 

SI7* 


TXo( I 1 •TtNii ,1 )«TS( 1 ,1 )*T(N, 2 »n*T$( 1 •2>*T<Mt3ii l*TS< 1 |3l 

sia* 


TTqI 1 1 *T(Nt r.2l*T5l 1 tl >*TlN.2i2)*TS( 1 t2>*TUt3i2l*TS( |i3) 

SIT* 


TZ0< 1 1 *T(hi 1 t3)*TS( 1 •ll*TlHt2t3>*TS< 1 •2l*TiMt3i3)*TSi 1 131 

S2o* 


0xolliII*TC*ilil)*0x(ltl)«T<Mt2il)*0Til|U*T(Hf3il>*DZ<i»ti 

<•21* 


OYol I,l>«T(M,|,2|*0X(I,t)*T(M,2,2|*0Y((,l>*T(H,3,2)*0Z( 1,11 

S22* 


OZo(Mt>*T<n,l,3)*OX(ti|>*T(H«2,3l*OT(|,|l*TlN«2'2)*oZlitl) 

S23* 


0Xo(i,t>*TiM,lil)*Dxii,Ll*T(M,2,l)*0T(l,Ll*T(Mi3,l)*0ZiiiL* 

S2S* 


0Y0( 1 ,U«T|H,| ,2i*0X|l,L)*TlM,2,2l*0Y( I ,L)*T(H,3,2)*02U iLi 

S25* 


020( l*Ll*T(n,l.3)*0Zlt,L)*T(M,2,3l*0T( I ,U * T | H ,3 , 3 > *0Z I i t L * 

S24* 


00 17 J>Iin9 

S27* 


1F(I,CQ,^) «0 TO 17 

S28* 


|F(CFS(K,J|«EQ«1) so TO 177 

S2T* 


iF(C«K,l)<eO*(J*l)> 00 TO 17 

S30* 


0X0< 1 ,j)*OxO( I ,Li 

S3|* 


OTo( I ,J)* 0 Y 0 ( I ,L| 

S32* 


020< 1 ijIaOZOl 1 ,U 

S33* 


«0 To 17 

S3S* 

172 

OXol 1 ,3l*Tlll,l , 1 1*0X1 1 ,3 >*t(n,2,I >*0t( t i J I *T t M |3 • 1 1 *0Z 1 1 

S3S* 


OTo< 1 , 3 I>T<N ,1 ,2|*0«l|,3l*r(n,2,2)*0T|l,J)*T(H,3,2)*0Ztl,J> 

S3** 


02o< |tgl«T<H,i,3)*0Xl |iJt*r<N,2i3)*0T(|,Jl*T|N,3,3)*0Zt |I3> 

S37* 

17 

COnTINUC 

S3«* 


00 3*7 I«l,Na 

S3t* 


OXO(lill>OXll,ll 

SSQ* 


OTo<1i|I*OTIi,II 

SS|* 

367 

OZo<lill*Ozll«|) 

SS2* 

C 


SS3* 

C 

compute total external force on VeNICLC IlN REFt coord, > 

sss* 

C 


sss* 


FTXO-O, 

SS6* 


FTy0*0» 

SS7* 


FTZ0>Q, 

ssa* 


00 2S7 N«1 ,NB 

SST* 


FTXO«FTXO*FExOIN| 

sso* 


FTt0*FTY0*F(Y01N| 

SS|* 

2S7 

FT20«FTZ0*FEZ0(N» 

SS2* 

C 


SS3* 

C 

additional AUONENTEO inertia otAOICS IlN RCF.SOOy FRAME) 

sss* 

c 


sss* 


00 37 |■I,N6 

ss«* 


00 37 j*|,n9 

SS7* 


IF|I,«E,UI «0 to 37 

sss* 


DX2«0X0( 1 tJI*OXO| Jtl) 

SST* 


OY2*oYO< I ,jl*OYOUf 1 ) 

s« 0 * 


0Z2«0Z0l I >U>*OZOU,) ) 

s*| • 


P5<l ,J,1 •l)“-TN*(0Yj*0i2) 

s* 2 * 


PSI 1 ,Jil i2l*TN*0X0(J,| >*0T0(|,Ul 

s*3* 


PSt| ,J,| ,3l"TM*0x0l J,| )*0Z0<| ,J> 

s*s* 


PS|I,<I|2,|I"TN*0Y0<U, 11*0X011, J) J 

s*s* 


PSl 1 , J,2,2I*«TH*IOX2 *oZ2) 

s*** 


PSI 1 ,3,2,3)«TH*OtO< J,| )*OZO l |,J) 

S*7* 


PS(|,J,3,1 )«TN*OzOI J,|)*0X0I|,J) 

s*a* 


PSI I ,J,3,2l*TM*0Z0l l*OYOl 1,3) 

S*T* 


PSIl ,J,3,3I«-TN*I0X2*0Y2) 

S7q* 


00 378 Na|,3 

S7l. 


00 379 N>1,3 

S72* 

37« 

PS|J,| ,H,N)*PSli ,3 'N,h) 
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•I?*** 

47&. 

«t76* 

<*77» 

‘17a* 

a7»« 

<tao* 

aaj* 

<t»z» 

<«a3* 

<tSH* 

naa* 

4|86* 

H87* 

naa* 

na?* 

<t90* 

MVl« 

H92» 

a9j» 

a»**» 

a9a» 

994* 

997» 

H9a* 

<*99« 

500» 

&0l» 

SQ2* 

SUi* 

509« 

SOS* 

ao4«- 

507* 

aoa* 

si09« 

aio« 

5ll» 

512» 

5J3* 

ai9. 

aia* 

ai6* 

bi7« 

Sla* 

bJ9» 

b2o« 

52j. 

522* 

b2j* 

b29* 

S2a* 

b24« 

527» 

b2a* 

&29» 

530* 

53l* 

S32* 
S33« 
539* 
53S« 
S34* 
S37« 
b3a* 
b39« 
590» 
59 j* 


37 continue 

00 75t H«l,3 
00 7SI Nat, 3 

751 PS( Itl •NiN)”PH< ItHiNI 
C 

c transponn aUsmcntcp aooT iNEKTU oTAOics To pEPt aoov prane 
c 

00 3*3 |•^•NB 
M*hI I I i 
00 3*9 U«li3 
DO 349 Ka|,3 
ABI JtK)«U> 

00 349 

AB( J.K )aAB( J,KI*PHI I ,g,t)*T (H,U|K> 

349 continue 

00 345 jaii3 
00 345 K-I«3 
PS( I , I .J.K)«0, 

00 345 U*l<3 

PS(lil.JiRI*PS(til»J.R»*T<HiLiJ**ABtt|K> 

345 continue 
343 continue 

C COhPuTe The TeCTORS for e*CN PLfeA* APPemOASe 

c 

DO 2oa k-i,nf 

KKaF ( K t I ) * t 
H4HI (KK > 

JNt"FIRi3) 

|F(KIC<eQ«l) 00 To 2090 
00 2 q 9 I-lt3 
PGsO(R» n*o* 

00 2q9 J«1,3 

209 POSO(K,l »«P4S0tR,|»4T»H,J,n»t«HCMK,Un 
00 To 208 
2q9u continue 

00 209 1 l-tO 
20vi P6S0<K , I ta.McMR ,tJ 

208 continue 

c vEctqr Cross products oEsCRiaiN® stster RotatJonae Cqupi In*» 
c (Quadratic teRns involvinq the connecting ^oot anqulaR 

C VECOcITIeS and the HUTUaL 8a"'^CENTER»H|Nge VECTORS! 

c 

00 230 Na| ,N b 
l*Pl (HI 
00 974 J"l|3 
974 C*l*0|N(JI«O« 

CPx"o* 

CPT"0» 

CP2«0* 

CPpAaO. 

CPpTaO. 

CPPZaOt 

OCpAaO* 

OCPTaO. 

OCPZaOt 

00 2301 U*|tNa 
lUaPl IE) 

IPl iLtNEtOI GO To 7199 
• 0*»l*TO«Ul»OZOlL.N»»*ZO<t»*OTO«l.*N> 

' W0t*nZ0<L ) *°A0 <L •nI'nAOIe I *OZoIL IN* 
NOZ-WAO(LI*OTO(E,N).«rO<i.)*OAOU.tN) 
N«FOA*4TO<L**ROZ««20Ie)*ROV 
N«FOy*«ZoIl* **OA»«AQ lEi*«OZ 
WWP02a«A0(L>«M0T.4r0(E)*R0A 
GO To 7198 
7199 CONTINUE 
»*POX“0« 
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5H2« 


«8FPTaQ« 

5«I3* 


M«F02"0« 


7 198 

continue 

5<I5« 


(Fd.EOtOi 8o TO 982 

5<t4* 


CN«0<Nil )*C««OlN| 1 )*««rox 

5<»7« 


C«N0(Nt2)*C««0<Ni2i*««F0V 

SHS* 


C8»0lN,3)«C8»0<N,3>**«f02 - -- 

6H»* 

982 

continue 

550* 


CPFX»CPF)l*8«F0X 

55l« 


cpfy>cpfy*«wfoy 

552* 


CPFZ»CPF2*88F02 

553* 


IF|N*E8«L> 60 TO 2301 

55<«* 


HttOX*TN*«NF0x*FExOlL) 

55S» 


MI«0T.Tn*N«F0Y*FCYOIL} 

554* 


«»DZ>TN*«Hr02*FCZO<l,l 

5S7» 


OnhOX*OYO« N'Li *8«02>0Z0IN*L> *8>0T 

5S8* 


D8«OY"OZOINiL> *8«OX.OXO(NtLl *«80Z 

559« 


ON*OZ>OXO(NiC> •••0T*0T0(N.L>*«80X 

540* 


CPX"CPX*0»»0x 

54 1* 


CPY»CPT*Oi»*Oy 

542* 


CP2*CPZ*0»»|02 

543* 

2301 

continue 

54<«* 


OFx«OTO(N|N) •FEZO lNl.OZOlNtNl.FEYOl N) 

54S* 


OFY*oZQ<NiN) •FEX0(N>.0X0<N«N|*FEZ0IN1 

544* 


0F2"0X0<NiN>*FEYoIN).0YOIN«N)*FEXoIN) 

547* 


IF(1,NE.0I 60 to 7197 

648* 


HX.PsiNtNt 1 • 1 I *NXO<Nt .PSlNtN.l • 2 I *« YO 1 N 1 *PS 1 u 1 N • 1 •3>*«Z0 In> 

549* 


Hr"PS<N«Ni2il l•«X0<N)*PS(N•N*2t2)*«Y0(N) *PslM>Ni2i3* *MZO<n) 

57o* 


NZaPS<N IN *3« 1 ) *8X0 (Nl*pS(NtN, 3,21 *NYolN>*PS<»,>Nt3i3>*«ZO<N) 

571. 


60 To 7196 

572* 

7197 

continue 

573* 


HX»0» 

57<** 


HYaO* 

575* 

7 1’96 

HZaO, 

574* 

continue 

577* 


|F( I«E6*0I 6o TO 293 

578* 


FACTaHSBlN»7TH 

579* 


FTx«aFTXO*F*CT 

580* 


FTY«aFTYO*FAcT 

58|* 


ftzh*ftzo*fAct 

582* 


P6FXa(P6S0| 1 , 2 1 • 1 FEZo 1 N 1 -F T Z| 1 » -P6S0 1 I , 3 1 * ( FE yO | N | .FT TN | I /nSB | N ) 

583* 


P6FTa(P6S0( 1 •3I*IFEX0 (n1*FTXnI-P 6S0I 1 , 1 l*lFtlO(N|.FTZNt 1 /nSBINI 

58M. 


POfZalPsSOI 1,1 (•(FEYolNl-FTTHl-PiiSOl I , 2 1 • 1 fE XU 1 N> -F TXH 1 1/n5B(nI 

588* 


P««0XaP6S0( 1 ,2» *CPFZ.P6S0« I ,xl *CPFY 

584* 


P8»0Y"PGS0« I ,3»*cPFX.PgS0U » 1 )»CPfZ 

587* 


P«40z-psS0n i 1 ••CFFY-pgSoIi |21*CPFX 

588* 


60 To 2 *»«* 

589* 

293 

continue 

59o* 


PGFXaQ, 

59 J* 


PGFYaOf 

592* 


P6rZaO. 

593* 


P8«0X*0< 

5Vn* 


P8*0y»O» 

59b* 


P8«0Z"0« 

594* 

299 

continue 

597* 


K a 3*|N«1) 

598* 


E«K*1 1 1 »“HY*«Z0<n1'*HZ»#T0«N»*TX0In» ♦CPX*0Fx*b6P**P»"0X 

599* 


E(K*2 • 1 laHZ*8X0(Nl-MX*«Z01Nl *TT0IN) *CPT*0 FY*p6FY-PII80Y 

400* 


E1k'* 3, 1 »aHX*8Y0<Nl"HY*8*0«Nl*TZ0lNl *CPZ*OF Z*p 6 FZ-P» 80 Z 

801* 

230 

continue 

402* 

f 


603* 

C 

AOO HATNIX ElENENT CONPUTxTTON 13x3) 

40H* 

C 


605* 


00 3q0I 1*1 >3 

606* 


00 3oOI Ja|,3 

607* 

3001 

a0O<I ijI^O* 

608* 


00 3 |a|,NB 

609* 


00 3 Uai ,NB 

6l0* 


Aooii.i»-Aoou,i)*Psu.J.i.n ORIGINAL PAGE IS 

OF POOR QUALITY 
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*» »• 

6 | 2 * 
613 * 
6 I H* 

* 16 * 

617* 

418* 

619* 

420* 

62 I • 
42^« 

423* 

429* 

42b* 

424* 

427* 

428* 

429* 

4Jb* 

42 I • 

422* 

422* 

42<t* 
42b* 
424* 
427* 
428* 
429* 
490* 
491* 
492* 
492* 
499* 
49b* 
494* 
497* 
498* 
499* 
4bu* 
4b I* 
4b2* 
4bJ* 
4b9* 
4bb* 
4b4* 
4b7* 
4b8* 
4b9* 
440* 
441* 
442* 
442* 
449* 
44b* 
444* 
447* 
448* 
449* 
470* 
f 71* 
472* 
472* 
479* 
47b* 
476* 
477* 
478* 
479* 


A00< I •2)*«00( I t2|*PS( 1 • i i2) 

*00 * 1 ) "Ago I I •2»*Pb( I • J 1 1 i2) 

A00(2>2laA00l2i2)*PS| I •J»2|2) 

A00< 2i2 )*AU0(2 •2)*PS( I •0>2 i2l 
A00*2»2l**00i2i2j*PSl 1 •J»2*2» 

2 continue 

A00<2it >*A00( I •2) 

AOO* 2 1 1 > "AOUt 1 
Aool2>2i*AoO(2«2t 

c FL£*» aPFenO* contribution To aOO HaTRI* computation <2A2i 

C 

00 2|0 Kp| |N8 
KKaF 1 ( K I 
00 210 L*liMB 
IFiK.bT.U Oo TO 210 

00 2102 1«1 i2 

00 2102 J*l »2 
2lw2 ' PSF (K iL 1 1 t J**0* 

LLaFIIUI 

IF(AK<EQ*UI 60 To 2101 
0Pl*P6S0lKKtl i*0xOlLtR) 

0P2*P«S0|AK t21*0Y0(LtK) 

OPJPPOSOIKK *21*020<LtK) 

FSF(K.L»l»l 1—0R2-0P2 
PSf»K.Li2»2»*-0Pi- 0P2 
PSFUiUi2t2)a*0Pl*0P2 
PSF 1 •2>*P6SotKK.21*OXOlL iR> 

PSf 1 •2l>P6So<KKt2)*OAOl|. tX> 

PSF(K«L«2)1 >sP6S0(KK,I)*0T0IL«K) 
PSf(k«Ci2i2>-P6S0(KKi2)*0T0(LiK 1 
PSF<KtLt2il l*P6S0<KICtl >*020il.>K) 
PSF(KiLi2i2l*P«SoUK,2}*0Z0(k.K) 

2101 continue 

iF|Lk*eQ«a) 60 To 210 
IF(K«Eo«U «0 TO 2102 
POlaPOSOUUt 1 l*OAO(K,kl 
•P02»P6S0«U.'21*0T0UtL> 

P0 2*P6S0<Lk '2I *0201* tL* 

PSFiKtLi 1 I 1 »*PSF , 1 1-P02*P02 

PSF(KtLi2i2l>PSF(K*L«2»2}-P01-P02 
PSf 1*»L» J»3’"PSFl*tLt2i21"P01-P02 
PSF Ir It • 1 i2 ••PSPlKit il »2>*OTOU iCl*p050ltt • 1 » 

PSF(K,L,1 i2>«PSFiK,t,l iSMOZOlKiklpPbSOlLt.l | 

PSf<KiL>Zi 1 **PSF(Kitt2ill*OXOIKiL>*PbbO(LLi2) 

PSf lKit*2i2**PSF(Kiti2i21*0Z0Uikl*P6$0ltti2) 

PSF U it i2i 1 »«PSF(K,t,2i 11*0*0 (K,tl*P6S01Ut,2l 
PSF(KitiZi2**PSF(KiLi2i21*oTO(KiU*P6$OltLi2| 

60 To 210 

21u2 continue 

00 2|9 ]al,2 
00 2l9 jai,2 

21‘t A8| I , J|PPSF 1* iLi I lUl 

00 2lS Ia|,2 
00 2lS J*i|2 

214 PSF Ik iLi I •u1"*0< I 1x1**881 Ji I 1 
2l«i continue 

00 2lSl K*| INB 
00 2|Sl t*l«NB 
IFlK.tEiLI 60 TO 21S| 

00 2191 1*1 i2 

00 2l9l j-112 

2191 PSFlKiLtliJ>*PSF(tiK,Oill 

2161 continue 

00 2009 .*■! INB 
KKaF] I k I 
00 2009 LaliNB 
kL-FHL) 

iFl IkKiEOiO* iAnO* ItLiEiliUl 1 60 TO 2o01 
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68g« 


00 3oo3 16|>3 


68|* 


00 3003 <16|>3 

> 

682* 


aOO( I .J| 6A00(| ,g)>PSF(8,L,I,J| 


68j* 

30w3 

continue 


66H* 

3qu8 

Continue 


6ttb* 

C 


> , 'j 

686* 

c 

aOk vector Clement computation I3xli 


687* 

c 

- . 


688* 

c 

AKM SCALAR Element computation 


68V« 

c 



69u* 


00 18 n6|iNH 


691* 


|««H|M)*1 


692* 


AV|N,|)6g, 


693* 


AV(M,2]>0> 


699* 


AV(Mt3|60« 


698* 


00 7 J6|,nB 


696* 


00 7 lalCiNB 


697* 


00 11 N>1 i3 


698* 


|FIEPS<Mil)<C9*0i 60 TO 7 


699* 


PS6( Jt 1 tNl60« 

‘.v^^'4 

700* 


00 10 L"l t3 

’:::y>.^ 

701* 

10 

PSftljt 1 (Nt-PSalUil •N}«<PS(jtt*N>L>*^Spl Ji I im^L* | 660lNiLl 


702« 

1 1 

AV«M|Ni6AV(M,Nl*PS6lj,|«N> 

y#| 

7036 

7 

continue 


70**6 


00 18 K«lfNH 


70S* 


|F<IC,6T«MI 60 TO 18 


706* 


J9sH(K|6| 


7076 


A1S< 1 l"0« 

1 '•-' 

7086 


A|s(2l60« 


709* 


*IS<3I"0« 


710* 


00 IS J«J6tNa 


7U* 


00 15 l6l6iNa 


7126 


|r((EPSUiJ*tE6«ol«0R«tEPSINt|)tEQ*0)> 60 TO 19 


7136 


00 IB N«1|3 


7|<*6 

18 

AlS<Nl6AtS(N)6pSQ| j,|,Nl 


7I5* 

19 

continue 

•;•*•:.■ • ,■ i 

7166 


AS(K,N|6«0||(,| )*AlS( 1 |«60(Kt216AISI2)660U,3t6AlSI3> 


7176 

18’ 

continue 


718* 

C 



719* 

C 

Agp hATR|A <3 X NKT) IREf* BoOT7FlEX> APPEnO*bE couplinsi 


720* 

C 



7316 


00 3|9 R6|,NF 


722* 


UKpF(Ki3) 

;•:; Vj 

7236 


JQpFiK, 1 |6| 


72H6 


00 322 |6|«3 


725* 


00 222 J6||3 


7266 

223 

AB< 1 ,U|60> 


7276 


00 221 L6li'<B 


7286 


AB| 1 .aiaABl 1 f2l«020(LtU6l 


7296 


ABI 1 (3|6AB( I f3l*0T0(LtU0l 


73Q6 

231 

ABt2,3)*AB(3,3|60X0(LiU0l 


73j6 


AB(2« 1 la^ABl 1 i2l 

•r V'-'-Vj 

<•'•/.-■•' ;Vc 

7326 


ABli.l )6 .aB(| |3I 


7336 


AB(3,2)6«AB<2f3l 


73H6 


00 220 lalt) 

'/ '"2 

7356 


00 220 J6||Jk 

■«'.i 

7366 


A0P(K»|,J)60LK0<K*lfUI 


7376 


00 220 L6||3 


7386 

220 

AOFIkH •UlaAOPlK.I iVI * AB I | ,L > aPrO ( K iL i J 1 


7396 

21» 

continue 


7806 

C 



78J6 

c 

AKF vector *1 X NKTI (FLEX* COUPLlNO 8|TH R|c30 SUBSTRUCTURES I 


7826 

c 



7836 


00 22** X"! |RP 

•■S&d 

788, 


UK.F|K,3| 


7856 


UO^FlKil l«t 


7866 


00 2285 jPlfjK 

!•,■•' H* 

7876 

22<*9 

3SR(K lUlsO* 


7886 


00 228 M6|.Nh 


7896 


00 231 I*!*} 
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^y-i 


'y'C'.-y-s 

7iQ» 


00 231 J-||3 


75|. 

23t 

AS( 1 , J)«Ot 


792* 


00 22* t*liNa 


753* . 


iF(epS(MiU«CQ«0) 60 TO 228 

“ V 

75<*« 


*8(1 ,2I-A8U ,2l*020ai^0) 

' 1 

755* 


ABC 1 i3)-AB(> .3>*OTO(tiOO) 

“ 1 

7S*« 


AB(2i3)-Aei2i3l*0A0(L*O«> 


757* 

22* 

continue 


758* 


A8l2il)«*A8<lt2) 


799* 


ABI3i1)»A8(iO> 


76q* 


A6(3|2I""*8<2»3) 


7Al» 


00 228 1*1.^ 

si 

762* 


00 228 J>1 lUK 

1 

s 

76i* 


OUR( I iJ>*OlKo(K>| tUl 


76H« 


IF(EPS(M,K)»E0tO) 0UN(ltJi«O« 

765* 


00 228 L*lU 


76«* 

228 

DUR< 1 f J>"ogN( 1 ijI'ABt | iL > *PKQ ( K t L i J 1 


7*7« 


00 22H| U*UUK 


768* 


00 22H| UII3 


7A9« 

22<tl 

ZSRIK.JI-Zs8|K,U)*0URU ,U I **6318,1) 


770* 


00 229 J-I,3K 


77i« 


AKr(KiMtJl*0« 

772* 


00 229 1*1,3 

■r ■ ■ •■■/ -\.i 

773* 

22» 

AKr(K|N,3)*AKF(K,M,3)*60(N, 1 )*OUR| ) ,J) 


774* 

22'* 

continue 


775» 

C 



776* 

C 

COhPUTE correction ElCHEnTS For (e) vector 

>• 

777* 

C 



778* 


00 H| J*2,NB 


779* 


JK*hU3> 


78o» 


Do Hit H*l,3 


7»l» 

HU 

C*( J,M)*0. 

782* 


00 42 K*l »JK 


783* 


IF (EPSIK ,J) «eo«0) 60 TO H2 

■‘hr^ 

78*t« 


C*(3, 1 l*CRI J, U*«6JU, 1 1 

785* 


CW|3,2)*C«(3,2I*N63(K,2> 


786* 


C«( J,3I*Cn«3.3U«6JU,3I 

^ ii 

787« 

H2 

CONTINUE 


788* 

HI 

continue 


789* 


00 Ho i*unb 


79o» 


EA(|t*0> 


79|« 


EA(2»*0* 


792* 


CA(3)-0* 


793* 


00 HqI 3-2, Na 


794» 


00 4507 H*U3 


795. 


00 4507 L*l ,3 

Sc| 

798* 

4507 

EA(N»*EaIN>*IPS« I ,3»N,L»*PSF« |»3,«»tU*C*l3rt> 


797* 

HOi 

COnT|NUC 

‘ 5 

798* 


A 1 *3* 1 I«U 


799* 


E lKl*l , 1 i*E (Kl*l •n*EA( 1 ) 


800* 


EUI*2,|I*C*KI*2,I »-CA«2) 


0Ol» 


e(Kl*3,U*E(KI*3,U*EA<3) 

■ly 

802* 

HO 

continue 


803* 


00 55 nl*l,3 


8u4* 

95 

EC 1 NI ) -C * HI , U 

V. 

805* 


00 92 3*2, nB 


806* 


00 92 H*l,3 


807* 


KJ*3*(3-U*N 


808* 

92 

EC|N.)*EC(N|«e<K|,U 

, , 

809* 


1*0 


8(0* 


00 60 K*i ,NN 


8U* 


3KaNIKl*l 


8|2* 


IFlPUKi •NE«0> 90 TO 60 


813* 


I*I*i 


814* 


ECl l*3l*0> 


815* 


00 6ol N-1,3 


816* 

60l 

CE(H)*0« 


817* 


00 6| 3*3K,N8 

:A'4 

818* 


IF lEPSIK , 3) «EQ«0I 60 TO 6| 
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819» 


00 65 H*1>3 



82o« 


3ia3*(3»l **7I 



82l« 

85 

«e<H|«C€<Nl*eiJl,ll 



822* 

61 

continue 



823* 


00 68 L"1*3 



82S« 

88 

ec( U3i«eci i*3>*60(k,u*ce{L) 



825* 


EC( U3|»CC< U3|*TH|K j 


•^:0i 

828* 

80 

continue 



827* 


DO 8(0 I"l «3 



828* 


00 6|0 J*l (NH 



829* 


lF(Fl<JI •£9*ai «0 TO 4l0 



830* 


EC( 1 l-ECi 1 )"AVIU.l I*6H00I3) 



83 I* 

810 

continue 



832* 


K*0 


^IKks-l 

833* 


I V«3 



839* 


00 8l2 1*1»>1H 



835* 


IF(P|m«NE«OI 60 TO 812 



836* 


K-R*l 



83/* 


|y«iy*i 


. ':7*?iy'A 

838* 


00 81 1 J*1 .NH 


1 

839* 


IF(Pl ( J) •E9«0i 60 TO 811 


r;.'j 

890* 


IF(l»GT«Ui ASI 1 iJlaASt Jtl 1 


■ ; 

89|* 


eC(K*3)"EC(K«3l*ASI 1 «jl*5f100( jl 



892* 

6|1 

continue 



893* 

812 

continue 


--' '■ 

899* 

C 




895* 

C 

COnPUTc 8T« HAnO SlOc OF APPenOA&e 

ENUATIonS ilN APPENDt COORDS*) 


898* 

C 




897* 


DO 9a3 k«i«nf 


■;\ .'■'••’:i'\ 

898* 


I*F<Kill*» 



899* 


H-HI ( I 1 



85U* 


C8(U«FT»0/TM * C«80(|,l) 


-S •'■'■'■•''j 

SSl* 


C«<2I*FTyo/TH ♦ c««0(It21 


'•>■. 5. ;k'- 



C0(3)*FT20/Tn ♦ C»80<I,3) 



853* 


lFII«eQ«l* 60 TO 9890 



859* 


Oo 989 j»l.3 



855* 


VE(K,J|«0. 


' 

858* 


00 989 L*l»i 



857* 

989 

VtiKi J»“VE(k, jI«x(n» j»l.**C6«i.» 



858* 


60 To 983 


}". 

859* 

989<| 

continue 


■[.'■i 

880* 


DO 9891 J*I *3 



88 1 • 

9891 

VE(K,ulaCu( J) 


y . •.••'.'‘i 

882* 

983 

continue 



883* 


00 985 K*l tNF 



889* 


NL«F IK f 2> 



885* 


DO 988 N*1 |NL 



888* 


N8«6«(N«1 ) 



887* 


00 988 J«l .3 



888* 


UNaN8*J 



889* 


JN«Jn*3 



870* 


VB|K,JN)>FFUiN. J» 


y'-'M 

871* 

988 

Ve<KiUH>*TFlKiNtj) 



872* 

988 

continue 


•w-« 

873* 

986 

continue 



879* 


NVal V 



875* 


00 991 K-I iNf 


,v .:•... •» 

876* 


JN*F|Ki3> 


■ ■f<. -o 

877* 


NC«F(K,2I 


» 

878* 


NL8«6*NL 


1 

879* 


00 992 J*IfJN 


0M 

880* 




i 

88 1* 


VVl**«F<Kf JI*|2t«2F|K>U>*ET0(KtU|*«FIK>U)*ET,K|3) > 

' • '< •.' 4 

882* 


00 993 N«1«Nl8 


1 

883* 

993 

VVl*VVl*El6lKiNiJl*VBlK»N» 


; 

889* 


00 999 Na|,3 


■ -V 

888* 

999 

VVl*VVl-PKlK,NtJ)*VElK»Nl 


■•^ ■■ --A 

888* 


VVl»VVl-2SR<KiJ> 



887* 


EC|IU«yV| 






ORIGINAL’- PAGE IS 

r 




OF POOR QUALTIY 


JPL TECHNICAL REPORT 32-1598 


113 




888* 


00 9920 L*1 tNH 


889* 


IFIPl <L) •eO'Oi 60 TO 9920 


89o* 


EC( 1L>*CCI lLt-«KFtL>K> J>*6 HOo(U 


89 I* 

992U 

continue 


892* 

992 

continue 


893* 

991 

NV«NV*JN 


89«|« 

C 



895* 

C 

ENTER constants INTO FLEA* BOOT PORTION OF CnEFF* NATR|X A 


896* 

c 



8V/» 


NV«| V 


89#* 


00 982 K*1iNf 


899* 


NLaF(K|3i 


900* 


00 943 1*I|Nl 


90l» 


lLaNV*| 


902* 


00 983 J-UMl 

\ 

903* 


UL«Nv«J 


909* 


AllL*UL>*0* 

ail 

90S* 


1F(|.CW*UI A(|LiJLI«1* 


9U8* 

983 

continue 


907* 

982 

NV«NV*NL 


90#« 

C 



909* 

c 

enter COLFF* MHiCH COUPLE REF. BOqt ANO PLEX. aPPENOABES |NTo A 


910* 

c 



9li« 


NV>iV 

^ V-i 

912« 


00 989 K*UNfT 


9i3» 


NLaF(K,31 


H9« 


00 985 da 1,3 


915» 


00 985 1*1|N|, 

'v;V'jV;-i 

916* 


1L*NV*1 


917* 


A( iL.dlaAjFlK.dil 1 

_*■ V^'vS 

9i«* 

988 

A( J, |L|aA< IL.Ji 


919* 

989 

N9aNV*NL 


920* 

< 



»i|* 

c 

enter coeff* bhich couple susstr. bodies ANO flEx« appeno. Into 


»22» 

c 



923* 


NValv 

V:».V.^^<^ 

929* 


00 988 R*i.NF 


925* 


NLaF(K,3) 


9^6* 


dl'aO 


927* 


00 987 d«l,NH 


928* 


|F(P| ( 3 ) 'NEtol 60 TO 987 


929* 


d|aJ|*| 


93d* 


00 9871 |a| > nL 

.•/'■•'•«"* v*?1 

93»* 


ILaNV*l 


132* 


A(IL,dl*3iaAKF|K,d.l) 


933* 


A( JU3, IL|aA( 1L,J|«3) 


939* 

98/ J 

continue 


93S* 

987 

continue 

IfliM 

938* 

988 

NVaNV*NL 


937* 

c 



938* 

c 

calculate flex* boot C00PL|N« coeff* aNO ENTrB INTO A NATRIX 

'■WpS- 

939* 

c 



99q* 


NCO*l V 

•J y.‘-;v.1 

99J* 


00 973 Lal.NF 

, 

992* 


NL>F(L|31 

-.■'V.VlV^ 

993* 


NNO*| V 

.■' A'.' '-'a 

999* 


00 979 K«1.Nf 


995* 


NRaF(K,3) 


998* 


IFlR*E«*Ll 60 TO 979 


997* 


00 975 I>I,NR 


998* 


IRaNROal 


999* 


00 975 d«l,Ni. 


950* 


dKaNCO*d 


95 1* 


Al |K, JK lag. 


9^2* 


00 9760 Nal.3 


953* 


Al |K ,dK (■Al Ik.JKI'PKOIKiN. 1 I *PK0 l|, |N »d 1 /TN 


959* 

978{i 

continue 


955* 


A< jK. IKlaAl U.dKl 

-v*l'’.'!;i 

958* 

975 

continue 


957* 

979 

nro*nno*nr 
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Tb«« 

973 

nco*nco*nl 


f&9« 

C 



9*b« 

C 

LOaO system NATMik iA> «|Tm AOOiAOKiAKN ELEMrNTS 


9*1* 

C 



9*2* 


DO 23 1*1 «3 


9*3* 


00 23 J«l |3 


96*»* 

23 

A( 1 (jlaAOOl 1 , Jl 


♦*5» 


00 29 1*1 i3 


9»6* 


k*0 


947* 


00 29 3*1 iNH 


94a* 


]F(P| Ijl aNE'Dl «0 TO 29 


949* 


•C»K*I 


97o* 


AlK*3il)*AV(3t|l 


97j* 


All • k«3)*Av(j.| 1 


972* 

29 

conTinuc 


973* 


K«0 


979* 


00 250 1*IiNh 


975* 


IFIPi l| l•NC•Oi «o TO 250 


974* 


A*K*1 


977* 


L*0 


97a* 


DO 26 3*1 iNH 


979* 


ir|Pl(3)*NE*o) 50 TO 25 

■ 

980* 


t*L*l 


9a 1* 


|F(K«fi7*L> 5o TO 24 

. >: 

982* 


*IK*3#L*2***SI I »3l 

MV.'t;:? 

983* 


fiO To 25 


989* 

24 

AU*3iL*2l*AiL*2*K*3| 


988* 

25 

continue 


984* 

250 

continue 


987* 

C 



988* 

C 

AN«U(.AR NOnEnTUH of the STSTiM 


989* 

C 



99(j* 


ir(FilNH«tl*NE*ll 80 TO 8752 

"‘/'S 

99i* 


00 5451 1«|*3 


992* 


HHII 1*0* 


993* 


Oo 5451 3*I*3 

l /):::■ 4 

. 999* 

5451 

HH(ll*MHIll«Alli3l*Eo<^* 


995* 


00 5452 1*1 >3 


994* 


00 5452 3*1 *«H 


997* 

5402 

HHI I I*HH< I I*AVI3i| l*«M0l3> 


998* 


00 5453 1*1 <3 


999* 


00 5453 K*l «NF 


1000* 


NCaf(K,3l 

’)';.0 

lOUl* 


00 5459 3*1 «NL 


1002* 

5459 

MH(|}*MM<|i*A0FlKil*3)*ET0lK.3l 


1003* 

5453 

continue 


1009* 


HM«SQNT(HH( 1 )««2 • MH12I**2 * HH(3|»*2| 


1005* 

8752 

continue 

" 0‘1 

1004* 

C 



1007* 

C 

SOLVE STSTeN NATrIX FOR REFERENCE OODT AN6t »CCKlCRAT10N ANO H|N«C 


lOoa* 

C 

(RELATIVE) rotational ACCELERATIONS 

,.Vv'twVj 

1009* 

c 



1010* 


NT«V*NTMO 

•'iVj.''^{i 

1011* 


1T«1V*NTN0 

■^li 

1012* 


xv-iv 


1013* 


call CHOLO I »92 , a ,ST • I T ,EC iO* 1 1 *0*7 1 


1019* 


00 9|0 3*NTi9i*l 


1018* 


IF(3«LE*V) 50 TO 913 


1014* 


3Va3«(V«IV| 

re/iiiv'i 

1017* 


EC( JI*ECI3V) 


1018* 


80 TO 910 


1019* 

9lJ 

continue 


1020* 


X*3"3 

••'^f^rvi? 

C-v^;-U 

1021* 


IF|Fi(kI«NC«OI 80 TO 911 


1022* 


eci3)*EClKy I 


1023* 


KVaXyal 


1029* 


80 To 910 


1025* 

911 

ECI3)*6MOOIK) 


1024* 

910 

continue 
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00 *oo3 1*1 tV 

1028* 

Tqu3 

>007( 1 |«CC( 1 1 

I029* 

, 

J-v 

1030* 


00 *001 K*liNF 

I8ii: 


NL«r(K,3) 

00 9002 N>|,nL 

1033* 


IO«l*N 

IDS'** 

*062 

eTOO(KiNl>EC(|Ot 

lOiS* 

9061 

l•l♦NL 

103A* 

*2 

continue 

1037* 


RETURN 

103«* 


end 


0lA6N0SriCS 


aTIUN Tine • 30*73 SUPS 


CSSkaTRAN.CSSu 
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Appendix E 

Subroutine MBOYFL Listing and User 
Requirements 

. Subroutine Entry Statements 

Same as MBDYFN (see Appendix D) 

Input/ Output Variable Type and Storage Specifications 
Same as MBDYFN (see Appendix D) 

External Subroutines Called 

AINVD — double precision matrix inversion subroutine. Inverts any real square. 

nonsingular matrix. A, and leaves the result in A (see statement 419). 

Subroutine Setup 

Same as MBDYFN (see Appendix D) 

Data Restrictions 
Same as MBDYFN 
Core Storage Required 
Code: 3500 words 

Data: ~ 500 words (minimum; varies with n, nf) 

Listing 


2 » 

a* 

6* 

7* 

8* 

to* 

u» 

12 » 

12* 

lb* 

l6* 

17* 

18* 

»9* 

2u* 

2»* 

22 * 


C 

C 

c 


c 

c 

c 


SUeRoUTlNt ''bOT^ Ult<C,CtRe»H*iPB,PAi<iiPl iNf ,r ,E|6 |REC|NF|MFi 2F ) 
A0jUST*8Lt OtMENSlONS 
IntEqER pi I 1) •C<NCt2l 

real HB( I ) ,Ha( NC , 7) tPU(NC,2l ,PA|N c,NC ,21 
PARAHETER BC-I ,qH*2>«F*itNA*l ,NKT-7 

PahAhETER N*K**»NK tS^qC* I , V*qM*2t ,S 2 » 2 « 5 » 8 "qH »NM»qN 

Parameter sT»v*qf 

additional Dimensioned variables 

double precision AtbT ,ST| ,«RxtSH| iBMASSISi 
integer EPS<q,Si.cPS|qc,b».H(Q»,H|ISI,FI<S).r*NF,2) 
real A00I2,2I ,AB(2f2l , AOF ( qF , 2 t NK T I i A KF I OF , Uh • NK T > , A b i W • q ) • A V I q • 2 I 
S,A|S|2) ,CE|2) ,CK|qF,2) ,CW<2I ,0«IS,Si ,UTIS,Sl .02IS,S> ,UX0(s»S| ,0T0l 
8S,sl«0Z0(S,S),DLKlqFi2«NxTl ,0UR<2,NKT I iEIGINf iNAK .NAT ),FEAU<SI|FEI 
>0IS*iFEZ0(S),FS(St3),G0(U.2l,G<qt2>ilAXtSI,lTTtSI,|Z2IS>ilAT«S)iU 

szis>,itz«si,lX(S,s),ltis,si,lz(s,s) ,msb(Si .mcaibf ,3> .Phis,), jl ,psg 
S(S,S, 2 ),Pb(S,S, 2 , 2 >,PK<qFi 2 ,MKTI iPGSO IBF 12 ) • Rii < NF • NK • 2 ) • ReC I NF • A • N 
SKn,TXOlS>iTTO<S),TZoiS>»Tiq, 2 t 2 I.TSIS, 2 )iUlwFiNK, 3 i,VElqFi 2 ).VBIu 
AF ,NAK > ,MF INF ,NKT ) ,27 INF ,NKT I •HHI 2 ) 
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<<J* 


2 Out valence (A|Pbl • ( lA«030* »>l7 iOTO* I ILZiOZOi 


2<»» 


NdaNc*! 


2b* 

c- 



2«» 

c 

OEFlNt EP3 (^i 3| USlNa C 


27* 

c 



2a* 


00 86 K*IiNC 


2»* 


00 06 J*2iNB 


2o* 


iF«K«eo> i3*t n cpsiK,j|6i 


2»* 


IF (K«LT* < J*1 n bO TO a? 


32* 


bo TO 86 


32* 

a7 

continue 

-■'-.‘•■'vA 

3<«* 


JOsK«l 


3b* 


Jl6j*l 


36* 


00 89 L*Og.Jt 

<^5 * 

37* 


lF|K.fiT«IL-l|l bO TO 89 


3a* 


IF 1 IcPSUiL l•E9•l ••AND* <C < 0* 1 • 1 > *E8 * iL* 1 M ) rPSlKtOlPI 

-S® 

3a* 




*»«* 

a9 

COnT |NuE 


••I* 

aa 

continue 


62* 


L*0 

ypi 

63* 


00 1 JaiiNC 


66* 


KKaCl J.2) 


6b* 


00 1 KaliKK 

-y 

66* 


L*L*1 


67* 


00 1 |a|,N8 


6a* 

1 

EPSILiI >*CPS(3,|| 

ji 

69* 

c 


•/I'.V'J'^'i:' 

So* 

c 

COnPUTE HillaCt 6HEKE t*»i|N6t LA8EL ANO CacOaNECTION LABEL 

■•-• -V>' 'J 

bj* 

c 



S2* 


1*0 


S3* 


00 8 Ua2|Na 

m 

b6* 


KKaC( 0 *l |2I 


bS* 


00 a k*|(Kk 


b6* 


|a|«| 


b/* 

a 

Hi I lajal 


ba* 

c 



bv* 

c 

compute H|(1|*J, 6HERE labUOY LA8EC*1 ANO JabEABEST HlNbE LAbEL 


60* 

c 



♦J* 


HI 1 1 |6| 

t‘* < t 

62* 


HI (NBIaNN 


63* 


00 67 I*NH,I 


66* 


|F(l,E9*ll bg TO 67 


6b* 


KlaNi 1 1 


66* 


K2aH< I-l I 


67* 


IF(Fi.E0«A2> bo TO 67 


6a« 


HI (K2*l 1*1.1 


69* 

67 

continue 

•' .> 1 .“."k 

70* 

c 


&M 

71* 

c 

OEFInE FI«u>*Kt allEfiE ga|>OOT.|.ABEi,*| «nO k i« APptN0AbE*LA8Ei. 


72* 

c 

(IF KaO, aoor Has no flea* APPiNOAbCl 


73* 

c 



76* 


00 238 N*l|Na 


7b* 

23'' 

FllNJ*o 

■ lT‘.'>S** 

76* 


00 262 K*|,Nf 

^r-..-.i 

77* 


JNar|K*ll*l 


7a* 

262 

rilUNlaK 

-;'iv,^.-i 

79* 


NFaNF 

" ,, 

ao* 


NBaNB 


ai* 

C 



a 2 * 

c 

define substructure masses 


ai* 

c 



a6* 


NSBlIlaMBITl 


«b* 


00 268 n«2iNb 


• 6 * 

26* 

MSBlN)aNAiN«l(7> 


67* 

c 



aa* 

c 

total NUHbeB of FLEAt A^PENOAbE MOOES TO BE RETAINED 


69* 

c 


■4Si 

90* 


NTMOaO 


9l* 


00 681 K*|,Nf 


IIS 
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*2* 

bbl 

NTH0*NTM0*F(Kt2l 


C 

initial calculation op ftAKTClNTeR VECTORS bta.T* SOOT 


C 

9s* 

C 

ANo HiNSe POINTS 

96* 

C 


97* . 


tXX<ll*NBI|l 

9a* 


lrY<l>*NBI2l 

99* 


MZ( 1 laNbM) 

lOU* 


IXTl iMMBlbl 

lUl* 


MZl M*H8(S> 

102* 


iTzl 1 >*NSIb< 

102* 


BNaSSM i*MB(7i 

i0<«* 


THbBMASSM i 

10b* 


00 2S J*2in,0 

1U«* 


IXxl JMNAI •! 1 

107* 


ITTUMNAI J*1 ,21 

10a* 


I2ZUMNAI J*1 ,2) 

109* 


ixy (jMNAM*! ibl 

llO* 


IXZ< JMNAt2«| tSi 

Ml* 


|YZUI*NAU«1 tb) 

M2* 


BNaSSI jl*MA*2«l l7i 

M2* 

2S 

Th*Th*BMASsI J> 

M<»* 


00 |b9 1*1 fNe 

Mb* 


llaMl 

Mb* 


00 lb9 J*1 «Na 

M7* 


Ol*J*°l 

M«* 


tPM<E0*J> ^0 TO M2 

11 9* 


1F|M67M| So to 70 

|2q* 


ipii*ca*M «o to bq 

Ml* 


IF(CPSMMJI*C0«M So to bQO 

M2* 

70 

LX(I,J|*PA(i|,ll,l) 

M2* 


i.T(|«ol*PAMMll|2l 

12<«* 


kZMM)*PAMl«l|«2l 

Mb* 


SO TO MV 

Mb* 

bOO 

continue 

M7* 


DO Sqo K*M«I| 

M«* 


IFICPS(KiU}«E9*li 00 TO SOO 

129* 

bOO 

continue 

Mo* 


60 To MV 

Ml* 

-soo 

LXI|MMP*<II«Ki|I 

M2* 


LT(liUI*PA<l|,Kt2* 

M2* 


L2(I|JI*PA(I|.Ki2I 

Mb* 


60 To |bV 

MS* 

bO 

00 Vo L*l'jl 

Mb* 


IFICPSILMI*E6tl) 60 TO 101 

127* 

90 

continue 

Mb* 


60 To MV 

M9* 

lOi 

LX(|,J|*PBM,|| 

IbO* 


LY(|,U|*PB(L,2| 

Ml* 


LZ( 1 iJI*PbUi2l 

M2* 


60 TO MV 

M2* 

lb<* 

LX(|,J)*0« 

Mb* 


LT|l,UMO« 

MS* 


LZI ItJMO* 

Mb* 

M’ 

continue 

M7* 


00 M N*|(NB 

Mb* 


do 12 J*ltNB 

M9* 


0X(N,UI*CA(N,J| 

|Sq* 


0Y|N,JI-LT(N,U| 

Ml* 


OZINt J|*LZ(N, j| 

M2* 


00 12 K«| iNB 

M2* 


OA(N,J)>OA(N,U|«|BHASS{KI/TN)«LX|NiK) 

Mb* 


0T(NiJ|«OT(N.j|«(aNASS(K|/TN|*LT<NlK| 

Mb* 

M 

0ZIN.JM02<NiUI*(BNAsS(KI/TM)«LZINiK) 

Mb* 

C 


Is;* 

c 

calculation of AU6NENTE0 INERTIA qTaOICS FOR EACH BOOT 

Mb* 

c 

M9* 


00 2| N*IinB 

Mo* 


RH|N| 1 1 1 l*|Xx(Nl 
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i*i» 


PH(N||t2)*«txYIN) 



1 * 2 * 


PH(N,I ,3|a.lx2(N) 



1*3* 


PHCN.2i2»*iYtJn> 



»♦<»• 


PH(N|2i3i*«lYZ<N| 



l*i* 


PH(N,3,3)*UZ<Mt 



(**• 


00 3o a*liN 8 



»*7« 


PHtNil it i*PH(Nti ti >*BMA5b(j)*(0V(N«J)**2*'0Z(uia>**2* 



l*S* 


PH(N. 1 |2)*PH(N« t •2i*»H*SSU)*DX (N,3) *OY(N|J) 

.-VlT'-'w^M 


1*9* 


PH(N,1 t3)apH(N,l,3)»BMASS|JI*0X(N,a)*0ZiM,J) 



j/a* 


PH(N(2i2)*pH(N«2.2l*BnASS( J**l0XlNiJ)**2902iM>a>*«2> 



»7|* 


PH(N,2t3i*PH(N,2.3)«Mt1ASSI J>*OV(N,JI*OZtN,a) 



172* 

30 

PH|N,3,3)apH(H,3,3)*aHASb( JI*(0 X|Ni^)**2*0Y(niJ)**2) 



17 3* 


PH<N|2i 1 )*PH(N()*2) 



J7<»* 


PH(N(3il)*PH(Ntlt3) 



»7i* 

3t 

PH|N,3i2)*PH(N.2»3i 

, tr’-.'l'i-'''''.I 


»7** 

C 




J77* 

C 

AOoiriONAt. AUaMENTCO (NCRTiA oYaOICS (IM Kef. BOOT fKAHC) 



J73* 

C 




»79* 


00 7&I J*|(Na 



ISO* 


00 7SI Hat, 3 



t«(* 


00 7&I n*1(3 



|« 2 * 

7&t 

PS(3iJiHtA)*PH(3tN»N) 



l«3* 


00 37 



189* 


00 37 Ja|,N 8 



185* 


80 TO 37 



18«* 


0X2"0X( 1 •JI*OxUt ( ) 



(87* 


0 Y 2 - 0 T( I iJ)*0Y(3,n 



)8«* 


022«02(tiJ)*OZ(at|) 

v'2v'i-‘^v 


(89* 


PS( 1 1 Jt 1 il •■-TP* 1072 * 022 ) 



190* 


PS( 1 , J. 1 t2)*THaOX( J.n*OT( 1 ,j) 

'^.tif:X'* 


l»»* 


P3( t iJi t •3)*Tn«0X(a*t l•OZ( 1 13) 

.■‘.’V’wT.i 


192* 


PS< 1 i3t2i| )"TH*Oy(<)») )*0X( 1 >J) 

r-i.*i';iJ 


|9i* 


P5(| ,g, 2,2) *-TK* 40X2*022) 



J9<»* 


PS(i,J,2,3)*TH*OT(g«))*OZ(),3) 



I9b* 


PS4 1 ,3,3,1 )*TH*OZ<0,|)*OxI 1 lO) 



J96* 


PS 4 1 ,J,3,2)*TH*OZ4J,1)*OT4 1 iJ) 



i’7* 


PS 4 1 ,J,3,3)"-TH*40X2*oY2) 



iva* 


00 378 N*4,3 

:'-=^ 


199* 


00 378 N*1,3 



200* 

378 

PS4g,|«M,N)*PS4i,JlN,M) 



20(* 

37 

continue 

‘ w 


202* 

C 




203* 

C 

Aoo MATRIX Element computation i3x3) 



20H* 

c 


m 


20^* 


DO 3001 l"l»3 



206* 


00 3ooi 3*1 *3 



2g7* 

3obl 

A00( 1 ,3)*0t 



208* 


00 3 )«I,N6 



209* 


00 3 3a4,NB 



21o* 


AOOl),l)*X004l,l)*P3ll,U,l,l) 



211* 


AOQll ,2 1 -AOO 41 ,2)*PS4 1 ,3,1,2) 



2)2* 


AOOl 1 ,3 )-AoOU ,3)*PS4 1,3, I ,3) 

■-A-V-i'-'.^/ 


213* 


AO0I2,2)*Aq042,2)*PS4I ,3.2,2) 

Ansi'S 


2)<t* 


AO0(2,3)BAO042,3)*PS4i ,3,2,3) 



213* 


AO0<3,3)*aO043,3|*PS4i ,3,3,3) 



2t6* 

3 

Continue 



2J7* 


A00<2i(>-Aq04|,2) 



21a* 


A0043,))*a004I,3) 



219* 


AOal3,2)*AO042,3) 



22o* 

C 




22i* 

C 

aOk vector Element computation I3xd 



222* 

c 




223* 

c 

AKM SCALAR ELEMENT COMPUTATION 



22<t* 

c 




22b* 


00 IH M*1inR 

■J 


226* 


lO-M4M)*l 



227* 


AV4M, 1 )*o, 



22a* 


AV4M,2)«0> 



229* 


AV lM,3)*0t 

iK: 

120 
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23q« 


Do 7 JaltNB 

2l»* 


^ 00 7 lalOtNB 

232* 


.00 II N«l>3 

233* 


iriEfSINt J}*e«*OI 60 TO 7 

23<«* 


PSelJil (NlaO. 

235» 


00 10 L*1>3 

236* 

10 

PSs(JtivN)>PS«(Jil tN|«PS(Jrl«N*Ll*6(A|L) 

237* 

U 

AV|N,N|«AV(n,N|«PS6i3,l iM) 

238* 

7 

continue 

23T» 


00 19 K*1«NH 

2*»o* 


1F(K.6TiP) so to 19 

2**l« 


J«|aH|K)«l 

2**2* 


. A|S( 1 (•O* 

2H3* 


Alsl2)*0* 

2H<t« 


A|S(3|>0< 

2*tS« 


00 IS J«J9*Nb 

2<i6* 


00 IS i«iUiNa 

217* 


iFHePSiKij).eo*o>«ofi*icps(N.ii«Eo>on so to is 

2S8* 


00 18 N-l»3 

2H9* 

18 

AlS(Nl"AiSIN|«pS6(Jt| tNl 

250* 

IS 

continue 

28i. 


AS(KtN)«6(K«l UAISI 1 |«6<Kt2>*AlS<21«6<K(3|,A,S(3) 

292« 

19 

continue 

2S3* 

i. 


2&H* 

c 

define PK(3 X nkt arrati 

2SS» 

C 

OCFINC OLK-TranSPOSE NaTR|X (3 X nRT aRRAT) 

2&8* 

C 


257» 


OO 201 Ka|>NF 

2&8* 


JNT»F(K«3» 

259* 


00 201 1>1|3 

260* 


00 201 J*I»UnT 

261* 


PF|K,|,J|>REclK|ltJ) 

2«2* 

201 

0LKIK.I«J|aNCC|K,|93,JI 

283* 

C 


249* 

C 

AOF HATRU <1 X NKT t (KCF. BoOT/F|.EX< APPEnO«6E COUPLInSI 

288* 

C 


288* 


00 2|9 Kai,NF 

287* 


UKariKiJ) 

288* 


JO«FU«ll*l 

289* 


00 222 !•! f3 

27o« 


00 222 J«t.3 

271. 

222 

AB| 1 ,J)aO, 

272* 


00 221 L«I«Nb 

273* 


ABI 1 .2I«A8I 1 •2)>02UiU0l 

279* 


AB( 1 iJIaABI 1 ,3I*0T It, JU) 

278* 

221 

A8(2t31«A8(2t31-0XlC.W07 

278* 


AB(2.U"«’A8(|,2I 

277* 


A8(3,| la.ABlI |3I 

278* 


AB(3,2)a«AB<2f3) 

279* 


00 220 I*l>3 ■ 

28o* 


00 220 J^lt'iK 

281* 


AOFIK f 1 iJtaOLKIK ,1 , J) 

282* 


00 220 L>I|3 

283* 

22g 

AOr ‘K» I »Jl»*OF<Kf 1 tjl - ABl 1 •|.>*PK IK'L* J* 

289* 

21» 

continue 

288* 

C 


28*« 

c 

AKF VEC^OP ‘1 * NKTI (FLtA* cOOPLlNO *1Th Rlglo SUBSTRUCTURES* 

287* 

c 

288* 


00 229 Kal ,NF 

289* 


JKaF(K|3l 

29g* 


JOaFiKfl 1*1 

29 l» 


00 229 N«1«Nh 

292* 


00 231 I«t|3 

293* 


00 231 Jal,3 

299* 

231 

ABI 1 • J)*0> 

29S» 


OO 228 L*liNB 

298* 


lF(EPS«N,L|tEa.O» SO TO 2J8 

297* 


A8( 1 fJlaASI 1 t2>-0ZILiUW) W 

ABC 1 .3*"A8U .3**0T<L.J0* -Q 

298* 
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*b<2>3l948(2,3>-0x<Li 

3(i0* 

229 

continue 

3Ut* 


Ab<2t 1 i"*AbU *2> 

302* 


A8(3» 1 l■••Aal 1 |3I 

3UJ* 

“ 

Aa|3t2)9~A8(2t3i 

30<t* 


00 228 Ial|3 

3U5* 


00 228 J*l iJK 

30«* 


0UR( liUl*ULA(K>U3l 

307* 


IF ICPSIHiK) •E8*UI 0UMUiJ|90. 

308* 


00 228 L9l *3 

309* 

229 

OUrI 1 • j)*0U8( 1 tJI'ASI IiLl*PK«KiLtJ> 

310* 


00 229 J91i3K 

31|» 


AKF(KtH,J).Ci. 

312* 


00 229 |■U3 

313* 

22» 

AAf (K iHf jl94KF (K (Ni 1 l.oURI | • jl 

3l<*» 

229 

continue 

3|5« 

C 


318* 

C 

ENTCM constants into fLEA. BUoT PoNTion Of CnLFF, NaTK)X a 

31 7» 

c 


3ia* 


1 V >3 

319« 


00 4|29 i*l«NH 

320* 


tF|Pl ( 1 1 •NE«0» 80 TO 4129 

32j« 


|V-|V*» 

322* 

4(29 

continue 

323* 


N9.lv 

32<«* 


00 942 K91«Nf 

328* 


Nt.F(K«3l 

32** 


00 943 l■l•l<L 

327* 


1U-NV*1 

32o* 


00 943 J*1|Nl 

329* 


JL.Nv*3 

330* 


A( lt«JLl90« 

33j» 


1F(I«EQ*2I A|IL|JL)>|. 

332* 

943 

continue 

3J3» 

942 

NVaNV*NL 

33<t* 

C 


335* 

c 

enter COtFF. 4Hlc« COUPLE »Ef , BOpT aNO fUt*. a'’PEN0A6E5 INTq a 

336* 

c 


337* 


NV«lv 

33«* 


00 949 K»l |N f 

339* 


NL.F«K,3| 

39q* 


00 945 J91i3 

3<M« 


00 945 |9||NL 

392. 


IL.NV*! 

393* 


a( iLt J|9 AJfUiUi t 1 

398* 

945 

A<JtlU"A«|LtUl 

395* 

949 

nv.nv*nl 

39** 

c 


397* 

c 

ENTER COEFF* «HlCH COUPLE SUysTRf BQUIE5 AnO FlCA* APPENOt InTO 

398* 

c 


399* 


NV.lV 

350* 


00 944 K9||Nf 

35|* 


NL9FlKt3i 

3!»2* 


31.0 

353* 


00 947 J9||Nh 

359* 


lF(Pl (3l «NE«OI 80 TO 947 

355* 


JlaJI*l 

354* 


00 947| 19|INL 

357* 


lL.NV«| 

358* 


Al IL, J| *31 -AKFIK, j, 1 1 

3S9* 


A« jl*3, |L»*A« IE>UI*3> 

34q* 

94?l 

continue 

34J* 

947 

continue 

342* 

944 

NVaNV*NL 

343* 

C 


348* 

c 

calculate FLgX, boot CUUPLlNii COEFF. ANO EnT.R INTO A MATRIX 

344* 

c 

* 

344* 


NCo9|V 

347* 


00 873 L*1 ,NF 


m 
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S2S; 

a*** 


NL*F|L|3) 

:Wv;^4 

iA9* 


NRo*1V 


i7u* 


•00 979 K*l,Nr 


37l* 


NRaf (Kt3) 


372* 


IFIKtEO'l.) 60 TO 979 


37j« 


DO 97S (■ItNR 


37<t* 


1KdNR0*{ 


37»* 


DO 975 J*l.Nl. 


37** 


JK*NC0*3 


377* 


A( IK, JK)-0« 


37a* 


DO 9750 N*li3 


3/9* 


A i 1 K • JK 1 *A II K , JK 1 «PK IK «N , 1 I «Pk U. ,N • J 1 / TH 


3«o* 

97So 

Continue 


34 1* 


Al jK, 1KI*A( IK.JK) 


3«2* 

97S 

continue 


3S3* 

979 

NfiO*NPO*NR 


3«*»* 

973 

nCo*nCo*nl 


3«b* 

C 


;-'.:,v.>;^ 

3a«* 

C 

LOaO SrSTbM matrix Ul aiTH A00,A0K,AKN CLEHrOTS 


3«7* 

C 



3«a* 


00 23 l*li3 


3a9* 


00 23 3*lt3 


39o* 

23 

A( 1 ,JI*ACO< 1,31 

;-,-;;;,V;-M 

39 1* 


00 29 1*1,3 


392* 


K“0 

)■ fi- ■•]%'■'« 

393* 


00 29 J*1,nH 


399* 


IF(Pll3)«NE,0) 60 TO 29 


39S* 


K"k*1 

.'••''V* ‘#.a 

39** 


AIK'»3i1»«A»Ij,1I 


397* 


Al 1 ,K*3i*AV 1 J,1 1 


398* 

29 

continue 


399* 


K-0 


too* 


00 250 1*1 •'IH 

si^ 

901* 


1F|P|I1)«NC*0| 60 TO 2&0 


902* 


K*K*l 


9U3* 


c*o 

U'-KilY. 

909* 


00 25 J«liNH 


90S* 


lF(Pll3l«NE*0l 60 TO 25 

»'>'--,.v'A 

908* 


L*t*l 


907* 


|F(K,«T*U 60 TO 2* 


908* 


A|K*3,I.*3I*6S< I ,31 


909* 


60 To 25 


9»0* 

26 

A‘r*3,l*3»*AIj.*3,k*3I 


9U* 

2S 

continue 


9»2* 

2S0 

continue 


913* 

C 



919* 

c 

solve STST^H matrix for reference boot aN6. 4CCElERaT|0N aNO H|N«e 


9iS* 

c 

IRElATIvE) rotational ACCElERAT tONS 


918. 

c 



9»7* 


nt*v*ntho 


918* 


IT*Iv*NTMO 


919* 


call A|NVO|A,STi I T, 5io95,«RK| 


920* 

10»5 

continue 


92 1* 


RETURN 


922* 


Entry HRATEInC,TN,TB,tA,FB,Fa,TF,FF,6h,6nO,6„OOiETiETO,80,hOoTiEtO 


923* 


SO.hHj 

■' 449 !\ 

929* 


HEaL TfI«F,'«K,3I ,FF (0F,NK,3I ,eTIOf,NKT ) iEToIqF tRKT) »T b(3I ,TAINCi3I 


92S* 


S,FBl3> ,EAInC, 3| ,6M|| 1 ,6M0I 1 ) •CNOPi | 1 ,THI 1 1 ,«ol 3 i , El S3 , 1 > 


92«* 


double precision ECIST) ,EToO|QF,NkT) ,RD0T| VI ,E8IST) 


927* 

C 



928* 

C 

boot*to*boot coordinate transformation matrices 


929* 

C 



930* 


00 335 3*1, Nh 


931* 


MMa3-l 


932* 


N*Hl3»*l 


933* 


AS||,|)*|« 

; 

939* 


AB| 1 ,2)*6M|3|*6I3,3I 


935* 


AB| 1 ,3)*>6Ml3l*6|3,2| 


93a* 


*8i2»1)**ABIi,2» 
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123 


Hi7» 


A8(2f2)*)« 


43tl* 


Att(2t3l"5H(3)*e(0,t ) 


<*3»* 


AB(3i 1 )*«AB( I > 3 ) 




AB(3t2l**Aa<2i3) 




AB(3,3|*|« 


<»H2« 


|F|J«EQ«1 1 &0 TO 3350 


4H3* 


00 321 L*4N'l 




If (CPSILtNI •e9«l| «0 TO 322 


IHS* 

321 

continue 


H4** 


fiO TO 3350 


4H/« 

32i 

k*l 


HIS* 


00 334 t*li3 


44V* 


60 334 n>l,3 


4bo* 


T(jiL(B)*Of 


4b J • 


00 334 1*1(3 


4b2* 

331 

T(JiLiH)*T(3iL iM>*ABlLt| )*T<K il iH ) 


4b3* 


00 TO 335 


4b4* 

335g 

continue 


4bb* 


00 3351 *3 


4b4* 


00 3351 n*ii3 


4b7* 

334| 

T( JiLiNI*AB(L.Mi 


4b4* 

335 

continue 


4bV* 

C ‘ 



460* 

C 

COOBO* TRanSfoRNaTIOn of 6 VICTORS iTo REFt .00^ FRAME) 

44|* 

c 



442* 


00 342 )*1(Nh 


4*3* 


00 342 J*l(3 


4*4* 


fiOl 1 tU)*0< 


44b* 


00 342 K*i,3 


444* 


60( 1 ,J)*(iO( 1 ,J)*T( 1 ,K, J)*6( 1 |K| 


447* 

342 

continue 


44S* 

c 



44V* 

c 

compute TOTAi. EATCRNaL PORCC QH EaCH SUBSTRUeTURE IIN 

REF( CoorO() 

470* 

c 



471* 


FEXOI 1 )*F8< 1 1 


472* 


FEYO(n*F0(2) 


473* 


FE20(H*F8<3| 


474* 


IF(P|(1I*E9*0) 50 TO 254 


47b* 


U*F1 1 1 ) 


474* 


3N«F(Ui2) 


477* 


00 253 3*I|0n 


474* 


FEAOI 1 »*FE*OU »*fF« lL»U* » » 


47 V* 


FEyO( 1 J-FtrOll |*FFI lL.Jf2» 


480* 

253 

FEZOI 1 )*FE20« 1 )*FFI )|.(3l3) 


481* 

254 

continue 


482* 


FS( 1 t 1 i*FExO( 1 ) 


483* 


FSU .2l-FeY0li 1 


484* 


FS(|,31*FE20||) 


48b* 


00 244 N*2(NB 


484* 


a*n*i 


487* 


00 2440 L*l>3 


488* 

2440 

FS|N,U*FA|R,L) 


48V* 


IFlFl (N)«E9*0i 50 TO 244 


49fl* 


1L*F|(N) 


4Vl* 


jK*F( IUi2l 


4V2* 


00 245 3*1, Un 


4V3* 


00 245 1*1(3 


4V4* 

245 

FS(N( |)*fS|N(I )*fF( IW( 3( n 


4Vb* 

248 

continue 


494* 

C 



497* 

C 

compute TNaNSL* aNO ROTAT, OISPLACEmEnTS of (FPEnOAOE 

SUB.BOoIES 

4V8* 

C 



49V* 


00 232 K*I(Nf 


&00* 


JNaF«K(2) 


bOt* 


EK*FU(3I 


502* 


00 233 J*|(3n 


6u3* 


00 233 1*1(3 


504* 


u I k 1 j 1 1 >*0( 


50b* 


I0*Ij*1)*4*| 
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50** 


90 233 L*ULk 

507« 

232 

UUtJtl >■9(K|J•n*el6(K||0tLi•CTlK•U 

5U8* 

232 

continue 

509* 

C 


510* 

C 

compute CtH* PePTURBaTION (FROM NOHt UNOeFoRmEO LOCATION) ON e*CH 

Sll* 

C- 

bUBSTRUcTURE NITh AN APPeNOaOE 1L0C«L COOROb.) 

5t2* 

c 

■ - - - - - . _ 

513* 


00 262 K-1|NF 

5»9* 


|K.F(K,| )*| 

5»5* 


JN«F|K ,3) 

516* 


00 243 I*li2 

517* 

242 

HCK(Ki|)*a« 

518* 


00 24b Jb1|2n 

519* 


00 24b |>1,2 

S20* 

24^ 

HCkUiI l“HCA«ICil )-PFlK»l •J»*tT<K.j) 

S2l» 


00 246 I>1,3 

522* 

246 

CK(K, 1 )aNCK I k ,1 >/M5B( |K) 

523* 

242 

continue 

529* 

C 


525* 

C 

Compute totAl external toroUe on e*Cm substructure 6*r.t* iTs 

526* 

C 

instantaneous C«M, tlN local COORq,, 

527* 

C 


528* 


00 268 l*1<2 

529» 

248 

TSI 1 IL)-TB(L) 

530* 


00 247 Na2,NB 

&-M* 


K»N»1 

532* 


00 247 L*1c2 

533* 

247 

TS|NtL)"TA|K,L) 

SJ9* 


00 2470 N>t tNB 

S3b* 


ILaFl IN) 

536* 


IF 1 Il«LQ<&* bO To 2470 

537* 


JNaFI IL i2) 

538* 


00 247| ua| ijm 

539« 


00 2471 L"l *2 

S90* 

2471 

TS(N,L)"TSIN.L»*Tr<lL»2*L» 

S9l« 

2473 

continue 

S92« 


00 249 Na) ,Ns 

S93* 


Kafl (N) 



IF(K,EQ«Ol ^0 TO 269 

b9S« 


TS«N,l laTSlN.l )«cK(K,2)afS,N,3)-CMKf3)*FStN.2) 

594* 


TS«Ni2J"TSINi2I*ckIk,3»*F5IN,| »-Ck«K»1 »*FSIn.3» 

b97* 


TSIN,3l"T5IN.3l»CKlK,| )•FS^N,2)-CK(K,2>•FSiN. 1 ) 

S98» 

249 

continue 

b99» 


00 271 Nat,Ne 

bbo* 


KaFi IN) 

bbl* 


IFlK.EOtU) *0 TO 271 

bb2. 


UNaF (K , 2) 

bb3* 


00 272 J-ltON 

bb9» 


R0A"RPI**U» 1 l♦UlK^Ut|) 

bbb* 


RUraRF|K,J,2)«u(K,J,2) 

bb«* 


RUZ*RFlKiJf2)«ulKi3t3* 

5b7» 


TSIN.I 1*TSIN| 1 l♦RUT•FF^A»Jf2»-RU^•FFU,J^2) 

bbs* 


TS 1 N, 2) aTS 1 N, 2 ) «RU2apF IK, 3, 1 ).RU A aFF IK. 3, 3) 

Sb9« 

272 

TSlN.3)*T5IN,3)*R0*»FFlKt3*2)-RUTaFFlKt3» 1 ) 

b«0* 

271 

continue 

b4|* 

C 


b42* 

c 

transform vectors to ref. bOoY FRaHE 

b63» 

c 


bo9» 


TAol 1 >*TSl 1 1 1 i 

b65* 


TYO< 1 ("TSI 1 i2) 

b46* 


TZOI 1 laTSt 1 i3l 

b*7« 


00 17 I*2fN8 

b48* 


Manl I I ) 

b69« 


K"I-l 

b/o* 


L*ClK( 1 »♦! 

57i« 


FEX0(I)aT(M.|,I>aFSIl,IlaT|M,2,|)4F5U,2)*TtM,3,l)aFSII,3) 

b72« 


FEYOl I )aTlMi| iZlaFSl 1 .|>*TIM,2i2)aFSIl>2)«TlMi2*2iaFSII(3) 

573* 


FEzOlI»"T‘H*I*3*»F5llil'*TlMi2f3laFSl|«2**TlM»3»2»«FSl|»2l 

b/9» 


TAolI) ■TlMit,|laTSII,l>«T|N,2,|)tTS<|,2>*TlH|2(l)«TblI,3) 
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5/5» 


TYoll> *Tln'l>2<*TS({tl7*TlNi2i2l*TSlii2>*T(Hi2»2)*T5(ll2t 

576* 


T20< 1 1 *T tmi i2**TS( 1 •! tN»2t2l*TS( 1 •2>*T<Mt2f2i*TSl 1 i3l 

577» 

. 

OXOtltl)*T>"ilin*OXUii>*TlM.2il>*OTU|l>*TtH,2»l)*02l(f i) 

57s« 


0T0(lil)*T|N.I.2|*0X||.ll*TlN,2,2|*0Tt 1,1 (•Tin, 2, 21*02(1 ill 

579* 


02o< 1 >1 (•TIM. 1 ,2l*0X(i ,| 1 *T(n, 2,2)*0M 1 ,1 i*T (N,3f2i*U2( 1 , 1 1 

5<»0» 


0X0* 1 •L>*T(H,1 »11«0x(| ,L l*T<h,2,|l*0T(l iL)*T(H,3,|1*02(I il* 

5itt* 


OTo(l,Li*T(N,|,2)*OX|i,L)*T(H,2,2)*Ori| ,L 1 *T | N , 2 , 2 1 *02 ( i ,l) 

5«2* 


020* 1 ,L>*Y(M,| ,2|*oXli ,L)«TI n»2,21*oT(| •L)*TlH,3,2i*02( 1 ,L* 

&83* 


00 17 J*tiNa 



1F(1,EQ«21 ftO TO 17 

Sbb* 


lF(CPS(K,JI«EO«tl 00 TO 177 

5tt6* 


lFIC(K,|i,C0*l2‘*|)l 60 TO 17 

b«/« 


0X01 1 ,J)>0X0( 1 ,L| 

5«tt* 


OTO* 1 ,g)*uTO( 1 ,1.1 

5tt9* 


02o* 1 , J>*020( 1 .Cl 

5»0» 


60 TO 17 

b»l • 

J77 

0X0* l,2)*T(**,l,t>*0X(l,J>*f*H,2tli*DT(l|Jl*Tin,2,| 1*02(1,21 

592* 


OTo( 1 ,2>*T(M,| ,21*0X(1 ,J1*T (h,2,21*0T( 1 ,2 1 *T ( N , 2 , 2 l *02 ( i ,2 1 

!^yJ• 


02o( l,2)*T(n,l,21*0XI I,21*T(H,2,2I*0T( 1,21*T|N,2,2I*02( 1,21 

599* 

J7 

continue 

Sib* 


00 247 1*1 , mb 

596* 


0X0(1 , 1 laOX (1,11 

597* 


OTo(I,1I*OT(1,1I 

b9s* 

2*7 

020*1>1>-U2*l,ll 

599* 

C 


4Uu* 

c 

confute tutal ekteRnbl force on Vehicle un ref. coonu.i 

60 I* 

c 


602* 


FTx0«0, 

402* 


FTtO*0, 

409* 


FTzOaQ, 

40b* 


00 297 N*1 ,Nb 

404* 


FTx0aFTX0*FEX0INl 

407* 


FTTO«FTTO*FETOtM} 

40#* 

29/ 

FT20«FT20*FE20(M1 

409*' 

C 


4lU* 

C 

confute the F6S0 vectors for each FLtX, AFPE^OAOe 


C 


412* 


00 2o8 Kal,MF 

412* 


KKaF(K,ll*l 

419* 


M«Hl (RRl 

4)b* 


2Nt*F(K,21 

4I«* 


IFiKK.EQ* II 60 To 2096 

417* 


00 209 lal,2 

41«* 


F6S0(K , 1 1*0* 

419* 


UO 2q9 <7*I ,3 

420* 

209 

F6S0(K, 1 1-P6S0(X,||*T(H,2, 1 1*CNCKIK,21 1 

42|* 


60 To 200 

422* 

20'’- 

Continue 

422* 


00 20*1 1*1*3 

429* 

2091 

P6S0(K, 1 1— HcK(K,i 1 

62b* 

20« 

Continue 

424* 

C 


427* 

C 

VECTOR CROSS PRODUCTS 0ESCRIb1M6 STSTEN ROTAtIONal COUPlInO, 

42tt* 

C 

|9UA0RaT|C TeRrS INV0LVIN6 THE cOHHECTlNo aOO’* ANOULaR 

429* 

C 

velocities ANO the mutual baRTCENTER*H|N6E VECTORS! 

42u* 

C 


421* 


00 220 Nal.NB 

422* 


l"Fl(Nl 

422* 


CPX"0* 

429* 


CPyao* 

42b* 


CFzaj, 

424* 


00 2201 Lal,NB 

42/* 


CFxacPX*oTo(N,Ll*Ft2o(L»*o20lN,L>*FET0(L> 

42tt* 


CPy*CFT*020* Nil 1 ‘FEXoIl 1*0X0 lN»L 1 *fE20(L 1 

429* 


CFzacP2«OXO(N,Ll*FEyo(L>*OyOiN,L)*FEXU(Ll 

490* 

22wt 

continue 

49|* 


1F(1,EQ*6I 60 TU 292 

492* 


F ACTaHSBlN )7 tm 

492* 


FIxNafTXO*FACT 
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FtYM»rTTO»FAcT 

•* rjvV'.? 

*HS* 


rT2H«f TZO»r*CT 




. f6FX«(P«S0( 1 ,2 )*iFCZ0(NI«FTZm)-P6S0| 1 ,31 • | Ft vO ( N| .fTTN) ) /nSO ( M| 


*S7« 


PSfV^IPASOU , 3i*(FEX0INl-FTXM)-P6S0l 1 ,1 >«iFtz0(Nl-FT2 H) I/mSBIN) 


*<!«• 


POFZalPGSOI 1 ,1 t*(FETOlMl*FTyN)«P«$Oi 1 ,2 1 • 1 Ft |0 i N1 «fTX(1) 1 /nSB ( M 1 


*t9« 


GO To 299 


*&o« 

293 

continue ■ - 

"-'^i.--.'- ‘;l 

*5l* 


PGFXaOt 


*52* 


pgft>o* 


«5j* 


PGfZ«0« 

«5<t* 

299 

continue 


«5b* 


X • 3*1H-|1 


*5«* 


ElX*| »l •■TX0(NI*CPX*FGFX 


*57« 


CIK*2,1I9TY0(NI*CPY*PGFT 

'Si 

458* 


C(K*3iI iaTZ0(N)*cPZ*FGF2 


459* 

230 

continue 


44Q« 

C 



44»* 

C 

compute CONPecTION ElEHENTS FOP IE) YECYOR 

'■^1 

^ 442» 

c 


443* 


00 55 M|"I,3 

ii 

449* 


EC|N|t«E(N|,|| 

445* 

00 52 ja2,N4 


444* 


00 52 H>li3 


447* 


Kla3«(J-l)«N 


444* 

52 

EC<N)*ECIN|*EIK|,|) 


449* 


l"0 

.f'.W'j] 

47g* 


00 40 k*1iNH 


47j« 


UK«H|K)«1 

.'i'-;’r-:7» 

472* 


lF(P|(Kl«NE*Ol 4o TO 40 

SSi 

4/3« 


l"l*l 


479* 


ECl l*3)«0« 

475* 


00 401 Hal, 3 


474* 

40 1 

CElHiaO* 


477* 


00 4| ua^K,Na 


4749 


|F<£PSIKiU)*E4*0) GO TO 4^1 


479* 


00 45 Ha|,3 

■;Si 

440* 


Ul«3a|Ua||«H 


44 1* 

45 

CE|H)acEIH)*ElJlill 


4«2* 

41 

continue 


443* 


00 44 C*l'3 

-': «¥i 

449* 

44 

CClIaZl^ECIIaxMGOIKiLMCCa) 


445* 


EC( U3)aEC| U3|«TH(K| 


444* 

40 

continue 

■S5^ 

4«7» 


00 4|0 l•l,3 

'‘•'••'.iUfc: 

444* 


00 4|0 J*1iNh 


449* 


IF<Pll J)«EG«ol GO TO 410 

■■■' 

490* 


ECll)«CCIi)*AV|U,|l*GH00|3) 


491* 

4|0 

continue 


492* 


Xao 


493* 


IVa3 


499* 


00 412 I«I,Nn 


495* 


IFlP| 1 1 1 *Ne*0> go to 412 


494* 


KaK9| 


497» 


1 Valyai 


494* 


00 411 Jal.NH 


499* 


1F|P|I J)*CG*0) GO TO 411 


700* 

r 

IF|i,GT*U) Asl 1 ,U|aAo(3,|l 


701* 


EC|Ka3)aEC|Pa3|a3S(| (UiaGNOOU) 


792* 

411 

continue 


703* 

412 

continue 


79‘t* 

C 



705* 

C 

COhPUTe PT, HANO side of aPPeN0a5e eP0«T10n5 ||N appeno* cooros,) 

704* 

707* 

C 

00 943 Kal,NF 


704* 


l•F»X»l>•l 


709* 


HaMlIJ) 


7to* 


CGI l)aFTXO/TH 

7M* 


CGl2)aFTY0/TM 


712* 


CQ|3}aFTZ0/TH 

j;!-yV-.v:j 

7»3« 


IFIliEGjII Go TO 989 o 
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7l*t« 


00 989 J«l|3 


7J5* 


VE(K(J1«0« 


7U» 


00 989 Lal|3 


7|7« 

9a9 

VE|K,JlaVe|K,J)*TtHiOiL)*CQ<U 


7ia« 


50 To 983 

\ > 

7 J9* 

9890 

continue 


720* 


00 9891' J«1 >3 


72»* 

9891 

VE(K, JlaCVMO) 


722* 

983 

continue 


723* 


00 985 K«1(Nf 


72<t* 


NL*r (K,2) 


725* 


00 9a* N>l,Nt 


726* 


N*a** <N*I * 


727* 


00 988 jal|3 


72a* 


3N«N**J 


729* 


JH*JN*3 


730* 


VB|KiJNI*7F (k«N(j1 

/.CviV'j'* 

731* 

*a5 

9BtKiJMt*1T^K<HtJ) 

V'/“ ' S 

73i* 

98* 

continue 

:<>:'■ J. 

733* 

985 

continue 


73*»* 


NV*1 V 


735* 


00 991 •C*1|9f 

|Ssii 

73a* 


JNaF(K,3) 


737* 


NL*F(Ki2i 


73a* 


NL*”**NL 

■•.ri'<’>i«5 'J 

739* 


00 992 <7*1 1*19 


790* 


iL.NVaJ 


7<M* 


VV 1*««f(F ij>*(2**ZF 1* I j1*eT 0 IK tJ)*«F <E ‘JI'eT iIV» J1 > 


792* 


00 993 N*ltNL* 


793* 

993 

VVl*VVl*C16<KiN|jl*ValKtN) 

;;;V;'r7*^4 

79*t* 


00 999 N*1|3 


795* 

999 

VV |*y V|«PK<K|Nt<7)*VelK*Nl 


79** 


EC( 1U*VV1 


797* 


00 9920 L*1 *NH 


798* 


ir |F| (L)*EQ*0> «0 to 9920 


799* 


EC(U>*EC< |U-AKF‘L»K»<7*»6NOoa> 


750» 

9T2o 

continue 


7bi* 

992 

continue 


7&2* 

99 V 

NV*Ny*JN 


753* 

C 



759* 

C 

ANoUlAR nonEntun of the system 


755* 

C 



75** 


lr|Pl INM*1) •NE»1) 50 TO 8752 


757* 


00 5*5| l*|i3 


75tt* 


HH 1 I 1 *o« 


759* 


00 5*51 <1*1'3 


7*U* 

5*51 

HH( 1 )-HHU |*aOO( 1 ,JI»«U(UI 

•/! 

7*1* 


00 5*52 l*l«3 


7*2* 


00 5*52 <7*1 tQH 


7*3* 

5*52 

HH(1 ]*HH< I I*AV1<7,1 )*5H0lJI 


7*9* 


DO 5*53 l*10 


7*5* 


00 5*53 K*l INF 


7*** 


NLariK.3) . 


7*7* 


00 5*59 J*ltNL 


7*8* 

5*59 

HH< I l*HH< 1 I*A0F(K •ltJI*ETI><K>J> 


7*9* 

5*53 

continue 


770* 


HNbSoRT I NHI 1 1 **2 ♦ hnI2)**2 ♦ HmI3»**2> 


771* 

8752 

continue 


772* 

C 



773* 

C 

SOt»E SYSTeH HaTriX for REF • bOI>7 aNO* aCCEL.. SUBSTRUCTURE 


779* 

c 

MINCE AN5LE aCCEL* • A^O FUExt BOOy mOOE aCCEL# 

!'5:'*v^'^ 

775* 

c 


■;/.\r*'vV'^-i 

77** 


00 *71 l*i|lT 


777* 


EOl 1 )-0« 


77a* 


00 *71 J"1iIT 


779* 

*71 

EQ( 1 )*EQI n*A( 1 •JI*ECIUl 

-^^'rJ;VS 

7*0* 


KVal V 


78|* 


00 9io J*NT»9»-1 

-:>''0.:'';-i 

782* 


iFlU.LEtV* So TO 913 
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.'5 

78J« 


dV»d«< VIV) 

A 

7»H» 

■ 

ECU)*e8(UV* 

7«S« 


60 TO 910 

►i 

7a«* 

913 

continue 

nil -- 

787* 


K»J-3 

fA 

788* 


IFtPl (K) •NE«0* 60 


789* 


EC(J|aC6(KV) 


79o« 


KV«K»»i 

'$ 

79l» 


60 To 910 


792* 

9l» 

EC(Ji«6H00(K) 

VI 

791* 

9|0 

continue 

■Jr) 

799* 


00 *710 1*1«3 


795* 

47 id 

ECm«EQU) 


796* 


00 9o03 iMtV 


797» 

9qU3 

NooTin*Ec<n 


798* 


*•¥ 


7»9« 


00 9qOI K«liNF 


8UO* 


NL.F|K,3| 

'll 

801* 


00 8002 N"1 INC 

VS 

802* 


IOa|*N 

•;j 

803* 

9q02 

CroO<K.Ni«EC< iO) 

>3 

809* 

90Ul 

l•|•Nt 


aob« 

92 

CONTINUE 


804* 


RETURN 


807* 


ENO 


DU«N0ST|CS 
ATlON time 

CSStvTRANtCSSL 


2<if<ta sups 
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